#include "main.h"

#define VERSION   0.2

#define START  PIN_D4
#define STOP1  PIN_D5
#define STOP2  PIN_D6

#include "GP2.h"

#define ONE_WIRE_PIN       PIN_E2
#include "ds1820.c"

void main()
{
   setup_adc_ports(NO_ANALOGS|VSS_VDD);
   setup_adc(ADC_CLOCK_DIV_2);
   setup_psp(PSP_DISABLED);
   setup_spi(SPI_SS_DISABLED);
   setup_wdt(WDT_OFF);
   setup_timer_0(RTCC_INTERNAL);
   setup_timer_1(T1_DISABLED);
   setup_timer_2(T2_DISABLED,0,1);
   setup_ccp1(CCP_OFF);
   setup_comparator(NC_NC_NC_NC);
   setup_vref(FALSE);

   TDC_reset();

   output_low(START);
   output_low(STOP1);
   output_low(STOP2);

   delay_ms(50);

/*
1 0 0 0 0 ADR2 ADR1 ADR0 Write into address ADR
1 0 1 1 0 ADR2 ADR1 ADR0 Read from address ADR
0 1 1 1 0 0 0 0 Init
0 1 0 1 0 0 0 0 Power On Reset
0 0 0 0 0 0 0 1 Start_Cycle
0 0 0 0 0 0 1 0 Start_Temp
0 0 0 0 0 0 1 1 Start_Cal_Resonator
0 0 0 0 0 1 0 0 Start_Cal_TDC
*/

   int32 ble,ret32;
   int16 ret16;
   int8 ret8;


   while(TRUE)
   {
      delay_ms(100);


      TDC_reset();
      delay_ms(100);
   
   //----------------------------------------------- Nastaveni registru
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(0<<24);
      ble|=(0<<20)|(0<<16)|(0<<14)|(3<<12)|(1<<10)|(0<<9)|(0<<8)|(0<<7)|(1<<6)|(1<<5)|(0<<4)|(1<<3)|(0<<2)|(0<<1)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);
   
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(1<<24);
      ble|=(2<<20)|(1<<16)|(0<<15)|(1<<14)|(0<<11)|(4<<8)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);
      
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(2<<24);
      ble|=(1<<21)|(1<<20)|(1<<19)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);
   
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(3<<24);
      ble|=(0<<22)|(1<<21)|(1<<20)|(1<<19)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);
   
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(4<<24);
      ble|=(4<<19)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);
   
      output_low(TDC_ENABLE);
      ble=0;
      ble=(8<<28)|(5<<24);
      ble|=(0<<21)|(0<<20)|(0<<19)|(0<<16)|0;
      spi_xfer(TDC_stream,ble,32);
      output_high(TDC_ENABLE);


   //----------------------------------------------- Vypis registru
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|0;
      spi_xfer(TDC_stream,ret8,8);
      ret32=spi_xfer(TDC_stream,0,32);
      output_high(TDC_ENABLE);
      printf("- %LX ", ret32);
   
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|1;
      spi_xfer(TDC_stream,ret8,8);
      ret32=spi_xfer(TDC_stream,0,32);
      output_high(TDC_ENABLE);
      printf("%LX ", ret32);
   
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|2;
      spi_xfer(TDC_stream,ret8,8);
      ret32=spi_xfer(TDC_stream,0,32);
      output_high(TDC_ENABLE);
      printf("%LX ", ret32);
   
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|3;
      spi_xfer(TDC_stream,ret8,8);
      ret32=spi_xfer(TDC_stream,0,32);
      output_high(TDC_ENABLE);
      printf("%LX ", ret32);
   
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|4;
      spi_xfer(TDC_stream,ret8,8);
      ret16=spi_xfer(TDC_stream,0,16);
      output_high(TDC_ENABLE);
      printf("[%Lu %Lu %Lu %Lu %Lu %Lu %Lu] ", (1&(ret16)>>12), (1&(ret16)>>11), (1&(ret16)>>10), 1&(ret16)>>9, 7&(ret16)>>6, 7&(ret16)>>3, 7&ret16);
      
      output_low(TDC_ENABLE);
      ret8=0;
      ret8=(0b1011<<4)|5;
      spi_xfer(TDC_stream,ret8,8);
      ret8=spi_xfer(TDC_stream,0,8);
      output_high(TDC_ENABLE);
      printf("%X\r\n", ret8);
   
   //----------------------------------------------- Mereni
   
      TDC_init();
      
      delay_ms(50);
      
      TDC_start_cycle();
      
      delay_ms(200);
      
      output_high(STOP2);  // Merime jenom jednim kanalem (druhy zrejme musi byt v H)
      
      output_high(START);
      output_low(START);
      delay_us(1);
      
      output_high(STOP1);
      output_low(STOP1);
      delay_us(1);
      
      
      output_high(STOP1);
      output_low(STOP1);
      delay_us(1);
      
      output_high(STOP1);
      output_low(STOP1);
      delay_us(1);
   
   
      
   //----------------------------------------------- Pocitani
      int32 nn;
      for(nn=3;nn<=5;nn++)
      {
         delay_ms(500);
            
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|0;
         spi_xfer(TDC_stream,ret8,8);
         ret32=spi_xfer(TDC_stream,0,32);
         output_high(TDC_ENABLE);
         printf("* %LX ", ret32);
      
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|1;
         spi_xfer(TDC_stream,ret8,8);
         ret32=spi_xfer(TDC_stream,0,32);
         output_high(TDC_ENABLE);
         printf("%LX ", ret32);
      
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|2;
         spi_xfer(TDC_stream,ret8,8);
         ret32=spi_xfer(TDC_stream,0,32);
         output_high(TDC_ENABLE);
         printf("%LX ", ret32);
      
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|3;
         spi_xfer(TDC_stream,ret8,8);
         ret32=spi_xfer(TDC_stream,0,32);
         output_high(TDC_ENABLE);
         printf("%LX ", ret32);
      
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|4;
         spi_xfer(TDC_stream,ret8,8);
         ret16=spi_xfer(TDC_stream,0,16);
         output_high(TDC_ENABLE);
         printf("[%Lu %Lu %Lu %Lu %Lu %Lu %Lu] ", (1&(ret16)>>12), (1&(ret16)>>11), (1&(ret16)>>10), 1&(ret16)>>9, 7&(ret16)>>6, 7&(ret16)>>3, 7&ret16);
         
         output_low(TDC_ENABLE);
         ret8=0;
         ret8=(0b1011<<4)|5;
         spi_xfer(TDC_stream,ret8,8);
         ret8=spi_xfer(TDC_stream,0,8);
         output_high(TDC_ENABLE);
         printf("%X\r\n", ret8);
      
         // Next calculation
         output_low(TDC_ENABLE);
         ble=0;
         ble=(8<<28)|(1<<24);
         ble|=(nn<<20)|(1<<16)|(0<<15)|(1<<14)|(0<<11)|(4<<8)|0x00;
         spi_xfer(TDC_stream,ble,32);
         output_high(TDC_ENABLE);
         
      }
   
   }

}