/********************************************************************\

  Name:         scs_2000_rfbeta.c
  Created by:   Stefan Ritt


  Contents:     Experiment specific code for RFBeta experimet in Sottens.

  $Id: scs_2000.c 2874 2005-11-15 08:47:14Z ritt $

\********************************************************************/

#include <stdio.h>
#include <string.h>
#include <math.h>
#include <intrins.h>
#include "mscbemb.h"
#include "scs_2001.h"

char code node_name[] = "SCS-2001-APP"; // not more than 15 characters !
char code svn_revision[] = "$Id: scs_2000_app.c 2874 2005-11-15 08:47:14Z ritt $";

/* declare number of sub-addresses to framework */
unsigned char idata _n_sub_addr = 1;

extern lcd_menu(void);
unsigned char button(unsigned char i);

/*---- Port definitions ----*/

bit b0, b1, b2, b3;

/*---- Define variable parameters returned to CMD_GET_INFO command ----*/

/* data buffer (mirrored in EEPROM) */

struct {
   float temp[8];
   float adc[8];
   unsigned char rel[4];
   unsigned char dout[8];
   unsigned char din[4];
   unsigned short period;
} xdata user_data;

MSCB_INFO_VAR code vars[] = {

   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T0",     &user_data.temp[0], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T1",     &user_data.temp[1], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T2",     &user_data.temp[2], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T3",     &user_data.temp[3], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T4",     &user_data.temp[4], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T5",     &user_data.temp[5], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T6",     &user_data.temp[6], 2 },                    
   { 4, UNIT_CELSIUS, 0, 0, MSCBF_FLOAT, "T7",     &user_data.temp[7], 2 },                    

   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC00",  &user_data.adc[0], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC01",  &user_data.adc[1], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC02",  &user_data.adc[2], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC03",  &user_data.adc[3], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC04",  &user_data.adc[4], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC05",  &user_data.adc[5], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC06",  &user_data.adc[6], 4 },                    
   { 4, UNIT_VOLT,    0, 0, MSCBF_FLOAT, "ADC07",  &user_data.adc[7], 4 },                    
                                                                                         
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout0",  &user_data.dout[0], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout1",  &user_data.dout[1], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout2",  &user_data.dout[2], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout3",  &user_data.dout[3], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout4",  &user_data.dout[4], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout5",  &user_data.dout[5], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout6",  &user_data.dout[6], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Dout7",  &user_data.dout[7], 0, 0, 1, 1 },

   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Rel0",   &user_data.rel[0], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Rel1",   &user_data.rel[1], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Rel2",   &user_data.rel[2], 0, 0, 1, 1 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Rel3",   &user_data.rel[3], 0, 0, 1, 1 },

   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Din0",   &user_data.din[0], 0 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Din1",   &user_data.din[1], 0 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Din2",   &user_data.din[2], 0 },
   { 1, UNIT_BOOLEAN, 0, 0, 0,           "Din3",   &user_data.din[3], 0 },

   { 2, UNIT_SECOND,  0, 0, 0,           "Period", &user_data.period, 0, 0, 3600, 1 },

   { 0 }
};

MSCB_INFO_VAR *variables = vars;
unsigned char xdata update_data[64];

/********************************************************************\

  Application specific init and inout/output routines

\********************************************************************/

void user_write(unsigned char index) reentrant;

/*---- Check for correct modules -----------------------------------*/

void setup_variables(void)
{
   /* open drain(*) /push-pull: 
      P0.0 TX1      P1.0 LCD_D1       P2.0 WATCHDOG     P3.0 OPT_CLK
      P0.1*RX1      P1.1 LCD_D2       P2.1 LCD_E        P3.1 OPT_ALE
      P0.2 TX2      P1.2 RTC_IO       P2.2 LCD_RW       P3.2 OPT_STR
      P0.3*RX2      P1.3 RTC_CLK      P2.3 LCD_RS       P3.3 OPT_DATAO
                                                                      
      P0.4 EN1      P1.4              P2.4 LCD_DB4      P3.4*OPT_DATAI
      P0.5 EN2      P1.5              P2.5 LCD_DB5      P3.5*OPT_STAT
      P0.6 LED1     P1.6              P2.6 LCD_DB6      P3.6*OPT_SPARE1
      P0.7 LED2     P1.7 BUZZER       P2.7 LCD_DB7      P3.7*OPT_SPARE2
    */
   SFRPAGE = CONFIG_PAGE;
   P0MDOUT = 0xF5;
   P1MDOUT = 0xFF;
   P2MDOUT = 0xFF;
   P3MDOUT = 0x0F;

   /* enable ADC & DAC */
   SFRPAGE = ADC0_PAGE;
   AMX0CF = 0x00;               // select single ended analog inputs
   ADC0CF = 0x98;               // ADC Clk 2.5 MHz @ 98 MHz, gain 1
   ADC0CN = 0x80;               // enable ADC 
   REF0CN = 0x00;               // use external voltage reference

   SFRPAGE = LEGACY_PAGE;
   REF0CN = 0x03;               // select internal voltage reference

   SFRPAGE = DAC0_PAGE;
   DAC0CN = 0x80;               // enable DAC0
   SFRPAGE = DAC1_PAGE;
   DAC1CN = 0x80;               // enable DAC1

   lcd_goto(0, 0);
   /* check if correct modules are inserted */
   if (!verify_module(0, 0, 0x74)) {
      printf("Please insert module");
      printf("   'AD590' (0x74)    ");
      printf("    into port 0     ");
      while (!button(0)) watchdog_refresh(0);
   }
   if (!verify_module(0, 1, 0x61)) {
      printf("Please insert module");
      printf(" 'Uin +-10V' (0x61) ");
      printf("     into port 1    ");
      while (!button(0)) watchdog_refresh(0);
   }
   if (!verify_module(0, 5, 0x40)) {
      printf("Please insert module");
      printf("    'Dout' (0x40)   ");
      printf("     into port 5    ");
      while (!button(0)) watchdog_refresh(0);
   }
   if (!verify_module(0, 6, 0x41)) {
      printf("Please insert module");
      printf("   'Relais' (0x41)  ");
      printf("     into port 6    ");
      while (!button(0)) watchdog_refresh(0);
   }
   if (!verify_module(0, 7, 0x21)) {
      printf("Please insert module");
      printf("   'OptIn' (0x21)   ");
      printf("     into port 7    ");
      while (!button(0)) watchdog_refresh(0);
   }

   sysclock_reset();

   /* initialize drivers */
   dr_ad590(0x74, MC_INIT, 0, 0, 0, NULL);
   dr_ad7718(0x61, MC_INIT, 0, 1, 0, NULL);
   dr_dout_bits(0x40, MC_INIT, 0, 5, 0, NULL);
   dr_dout_bits(0x41, MC_INIT, 0, 6, 0, NULL);
   dr_din_bits(0x21, MC_INIT, 0, 7, 0, NULL);
}

/*---- User init function ------------------------------------------*/

extern SYS_INFO idata sys_info;

void user_init(unsigned char init)
{
   unsigned char xdata i;
   char xdata str[6];

   /* green (lower) LED on by default */
   led_mode(0, 1);
   /* red (upper) LED off by default */
   led_mode(1, 0);

   /* initialize power monitor */
   for (i=0 ; i<3 ; i++)
      monitor_init(i);

   /* initizlize real time clock */
   rtc_init();

   /* initial EEPROM value */
   if (init) {
      for (i=0 ; i<4 ; i++)
	     user_data.rel[i] = 0;
      for (i=0 ; i<8 ; i++)
	     user_data.dout[i] = 0;
	  user_data.period = 0;
   }

   /* write digital outputs */
   for (i=0 ; i<8 ; i++)
      user_write(8+i);

   /* display startup screen */
   lcd_goto(0, 0);
   for (i=0 ; i<7-strlen(sys_info.node_name)/2 ; i++)
      puts(" ");
   puts("** ");
   puts(sys_info.node_name);
   puts(" **");
   lcd_goto(0, 1);
   printf("   Address:  %04X", sys_info.node_addr);
   lcd_goto(0, 2);
   for (i=10 ; i<strlen(svn_revision) ; i++)
      if (svn_revision[i] == ' ')
         break;
   strncpy(str, svn_revision + i + 1, 6);
   *strchr(str, ' ') = 0;
   printf("  Revision:  %s", str);
}

#pragma NOAREGS

/*---- Front panel button read -------------------------------------*/

bit adc_init = 0;

unsigned char button(unsigned char i)
{
unsigned short xdata value;

   SFRPAGE = ADC0_PAGE;
   if (!adc_init) {
      adc_init = 1;
      SFRPAGE = LEGACY_PAGE;
      REF0CN  = 0x03;           // use internal voltage reference
      AMX0CF  = 0x00;           // select single ended analog inputs
      ADC0CF  = 0x98;           // ADC Clk 2.5 MHz @ 98 MHz, gain 1
      ADC0CN  = 0x80;           // enable ADC 
   }

   AMX0SL  = (7-i) & 0x07;      // set multiplexer
   DELAY_US(2);                 // wait for settling time

   DISABLE_INTERRUPTS;
  
   AD0INT = 0;
   AD0BUSY = 1;
   while (!AD0INT);   // wait until conversion ready

   ENABLE_INTERRUPTS;

   value = (ADC0L | (ADC0H << 8));

   return value < 1000;
}

/*---- Power management --------------------------------------------*/

bit trip_5V = 0, trip_24V = 0, wrong_firmware = 0;
unsigned char xdata trip_5V_box;
#define N_BOX 1 // increment this if you are using slave boxes
#define CPLD_FIRMWARE_REQUIRED 2

unsigned char power_management(void)
{
static unsigned long xdata last_pwr;
unsigned char xdata status, return_status, i, a[3];
unsigned short xdata d;

   return_status = 0;

   /* only 10 Hz */
   if (time() > last_pwr+10 || time() < last_pwr) {
      last_pwr = time();
    
      for (i=0 ; i<N_BOX ; i++) {

         read_csr(i, &status);

         if ((status >> 4) != CPLD_FIRMWARE_REQUIRED) {
            led_blink(1, 1, 100);
            if (!wrong_firmware) {
               lcd_clear();
               lcd_goto(0, 0);
               puts("Wrong CPLD firmware");
               lcd_goto(0, 1);
               if (i > 0) 
                 printf("Slave addr: %bd", i);
               lcd_goto(0, 2);
               printf("Req: %02bd != Act: %02bd", CPLD_FIRMWARE_REQUIRED, status >> 4);
            }
            wrong_firmware = 1;
            return_status = 1;
         }

         monitor_read(i, 0x01, 0, a, 3); // Read alarm register
         if (a[0] & 0x08) {
            led_blink(1, 1, 100);
            if (!trip_24V) {
               lcd_clear();
               lcd_goto(0, 0);
               printf("Overcurrent >1.5A on");
               lcd_goto(0, 1);
               printf("   24V output !!!   ");
               lcd_goto(0, 2);
               if (i > 0) 
                  printf("   Slave addr: %bd", i);
               lcd_goto(15, 3);
               printf("RESET");
            }
            trip_24V = 1;
         
            if (button(3)) {
               monitor_clear(i);
               trip_24V = 0;
               while (button(3));  // wait for button to be released
               lcd_clear();
            }

            return_status = 1;
         }

         if (time() > 100) { // wait for first conversion
            monitor_read(i, 0x02, 3, (char *)&d, 2); // Read +5V ext
            if (2.5*(d >> 4)*2.5/4096.0 < 4.5) {
               if (!trip_5V) {
                  lcd_clear();
                  led_blink(1, 1, 100);
                  lcd_goto(0, 0);
                  printf("Overcurrent >0.5A on");
                  lcd_goto(0, 1);
                  printf("    5V output !!!");
                  lcd_goto(0, 2);
                  if (i > 0) 
                     printf("    Slave addr: %bd", i);
               }
               lcd_goto(0, 3);
               printf("    U = %1.2f V", 2.5*(d >> 4)*2.5/4096.0);
               trip_5V = 1;
               trip_5V_box = 1;
               return_status = 1;
            } else if (trip_5V && trip_5V_box == i) {
               trip_5V = 0;
               lcd_clear();
            }
         }

      }
   } else if (trip_24V || trip_5V || wrong_firmware)
      return_status = 1; // do not go into application_display
  
   return return_status;
}

/*---- User write function -----------------------------------------*/

void user_write(unsigned char index) reentrant
{
   update_data[index] = 1;
}

/*---- User read function ------------------------------------------*/

unsigned char user_read(unsigned char index)
{
   if (index);
   return 0;
}

/*---- User function called vid CMD_USER command -------------------*/

unsigned char user_func(unsigned char *data_in, unsigned char *data_out)
{
   /* echo input data */
   data_out[0] = data_in[0];
   data_out[1] = data_in[1];
   return 2;
}

/*---- Application display -----------------------------------------*/

bit b0_old = 0, b1_old = 0, b2_old = 0, b3_old = 0;
static unsigned char flag = 0;
static unsigned long tlast = 0;
static unsigned long ttogg = 0;

unsigned char application_display(bit init)
{
   /* clear LCD display on startup */
   if (init)
      lcd_clear();

   /* display ADCs */
   lcd_goto(0, 0);
   printf("T0: %1.2f C", user_data.temp[0]);
   lcd_goto(0, 1);
   printf("T1: %1.2f C", user_data.temp[1]);

   lcd_goto(0, 2);
   if (user_data.period > 0 && user_data.dout[0]) {
      if (flag)
         printf("Off in %1.1f s  ", user_data.period - (time() - tlast)/100.0);
      else
         printf("On in %1.1f s   ", user_data.period - (time() - tlast)/100.0);
   } else {
      if (user_data.dout[0])
         printf("On           ");
      else
         printf("Off          ");
   }

   lcd_goto(0, 3);
   printf("VARS");

   /* enter menu on release of button 0 */
   if (!init)
      if (!b0 && b0_old)
         return 1;

   b0_old = b0;
   b1_old = b1;
   b2_old = b2;
   b3_old = b3;

   return 0;
}

/*---- User loop function ------------------------------------------*/

void set_float(float *d, float s)
{
  /* copy float value to user_data without intterupt */
  DISABLE_INTERRUPTS;
  *d = s;
  ENABLE_INTERRUPTS;
}

void user_loop(void)
{
unsigned char xdata i, n;
float xdata value;
static unsigned long last = 0;

   if (time() > last) {
      last = time();
      
      /* manage periodic signal */
      if (user_data.period == 0 && update_data[16]) {
         /* if period is zero, do normal output */
         update_data[16] = 0;
        dr_dout_bits(0x40, MC_WRITE, 0, 5, 0, &user_data.dout[0]);
      } else if (user_data.period > 0) {
         if (update_data[16]) {
            /* start or end a cycle */
            update_data[16] = 0;
            flag = user_data.dout[0];
            dr_dout_bits(0x40, MC_WRITE, 0, 5, 0, &user_data.dout[0]);
	    	   user_data.dout[1] = user_data.dout[0]; 
      	   tlast = time();
         }
         if (user_data.dout[0] && time() >= tlast + (unsigned long)user_data.period * 100l) {
            /* do periodic toggling */
            flag = !flag;
            dr_dout_bits(0x40, MC_WRITE, 0, 5, 0, &flag);
   			user_data.dout[1] = flag; 
            i = 1;
            if (flag == 0)
               dr_dout_bits(0x40, MC_WRITE, 0, 5, 1, &i);
            else
               dr_dout_bits(0x40, MC_WRITE, 0, 5, 2, &i);    
      	   tlast = time();
            ttogg = time();
         }
      } 
      
      if (ttogg > 0 && time() >= ttogg+100) {
         ttogg = 0;
         i = 0;
         dr_dout_bits(0x40, MC_WRITE, 0, 5, 1, &i);    
         dr_dout_bits(0x40, MC_WRITE, 0, 5, 2, &i);    
      }

      /* read temperatures */
      for (i=0 ; i<8 ; i++) {
         n = dr_ad590(0x74, MC_READ, 0, 0, i, &value);
         if (n > 0)
            set_float(&user_data.temp[i], value);
      }
      
      /* read ADCs */
      for (i=0 ; i<8 ; i++) {
         n = dr_ad7718(0x60, MC_READ, 0, 1, i, &value);
         if (n > 0)
            set_float(&user_data.adc[i], value);
      }
      
      /* check if anything to write */
      for (i=17 ; i<24 ; i++) {
         if (update_data[i]) {
            update_data[i] = 0;
            dr_dout_bits(0x40, MC_WRITE, 0, 5, i-16, &user_data.dout[i-16]);
         }
      }
      for (i=24 ; i<29 ; i++) {
         if (update_data[i]) {
            update_data[i] = 0;
            dr_dout_bits(0x41, MC_WRITE, 0, 6, i-24, &user_data.rel[i-24]);
         }
      }
      
      /* read OptIn */
      for (i=0 ; i<4 ; i++) {
         dr_din_bits(0x21, MC_READ, 0, 7, i, &user_data.din[i]);
      }
      
      /* read buttons */
      b0 = button(0);
      b1 = button(1);
      b2 = button(2);
      b3 = button(3);
      
      /* manage menu on LCD display */
      lcd_menu();
	}
}