//Meteorologicka cast
#define VERSION "0.1"
#define AUTOR "Jan Chroust"
#define DATE "15.4.2013"

#include <main.h>
#include <math.h>
#include <string.h>

#include "SHT25.h"
#include "MPL3115.h"
#include "HMC5883L.h"

#define  SEND_DELAY     50       // Cas mezi dvema znaky na RS232

char  VER[4]=VERSION;

unsigned int16 timer0_overflow_count;
float anemo=0;



#int_TIMER1
void  TIMER1_isr(void) 
{
// 32.768 kHz krystal pro timer1 oscilátor
  anemo = ((timer0_overflow_count * 0xFF) + get_timer0())/(32768.0/0xFFFF); // pocet pulzu za 1s
  anemo = anemo / 2;  //pocet otacek za sekundu

  timer0_overflow_count=0; //nulovani
  set_timer0(0);
  set_timer1(0);

}

#int_TIMER0 //pro preteceni èítaèe pùlzù od anemometru (RA4)
void  TIMER0_isr(void) 
{
 timer0_overflow_count++;
}


float azimut (void) //vypocet azimutu smeru vetru
{
signed int16 X,Y,Z;
X= mag_readX();  
Y= mag_readY();
Z= mag_readZ();

float a, b;
a=(float)Y/X;
b=atan(a);
b = (b/3.14)*180;
b=abs(b);

if(X==0) //osetreni proti deleni 0
   { 
       if(Y>0)
         { 
         b=90;
         }
      else
         {
         b=270;
         }
   }  
   else
      {
      if(X>0)
       {
       if(Y>=0)
       {
         b=180+b;
       
       }
       else
       {
         b=180-b;
       
       }
       }
      else
       {
       if(Y>=0)
       {
         b=360-b;
      
       }
       else
       {
         b=b;
       
       }
       }
         
      }   

return b;
   
}






void uvitani(void)               // uvodni zprava
{
   printf("\r\n\r\n# Meteorologicka stanice %s (C) 2013 www.mlab.cz \r\n",VERSION); 
   printf("\r\n# Autor: %s Posledni uprava: %s \r\n",AUTOR, DATE);// Welcome message
   printf("# ver poradi ");
   printf("altimet_t[°C] altimet_a[m] altimet_p[Pa] ");
   printf("sht_t[°C] sht_h[%%]  Anemo[m/s]check\r\n\r\n");
}

void main()
{
   setup_wdt(WDT_2304MS); //nastavení resetu pokud nedojde v cas k jeho vynulovani
   restart_wdt();  //---WDT
   setup_adc_ports(NO_ANALOGS|VSS_VDD);
   setup_adc(ADC_CLOCK_DIV_2);
   setup_spi(SPI_SS_DISABLED);
   setup_timer_0(RTCC_EXT_L_TO_H|RTCC_DIV_1);
   setup_timer_1(T1_EXTERNAL|T1_DIV_BY_1|T1_CLK_OUT);
   setup_timer_2(T2_DISABLED,0,1);
   setup_ccp1(CCP_OFF);
   setup_comparator(NC_NC_NC_NC);// This device COMP currently not supported by the PICWizard


float altimet_t;  //teplota z MPL3115
float altimet_p;  //tlak z MPL3115
float altimet_a;  //vyska z MPL3115
float sht25_t;    //teplota z SHT25
float sht25_h;    //relativni vlhkost z SHT25
float smer_v;     //smer vetru
 
unsigned int16 poradi=0; //cislo vzorku
unsigned int8 sht_config;

//nastaveni SHT25
SHT25_soft_reset();
sht_config = SHT25_RH12_T14 | SHT25_HEATER_OFF; //vypnuti topeni v SHT25
SHT25_setup(sht_config);

//nastavení pøerušení pro anemometr
enable_interrupts(INT_TIMER1);   
enable_interrupts(INT_TIMER0);
enable_interrupts(GLOBAL);
restart_wdt();  //---WDT

uvitani();
set_mag(); //nastaveni magnetometru pro smer vetru

// vynulovani promenych pro anemometr
   set_timer0(0);
   set_timer1(0);
   timer0_overflow_count=0;
   anemo=0;
   
   restart_wdt();  //---WDT

while(TRUE)
   {
   char output[12];   // vystupni zasobnik
   int8 j;           // ukazatel na retezec
   int8 check=0;     // Checksum is calculated between '$' and '*'
   
  
   mpl3115_setP(); //nastaveni pro tlak a teplotu
   delay_ms (500);
   altimet_t=mpl3115_T();
   altimet_p=mpl3115_P();
   
   mpl3115_setA(); //nastaveni pro vysku a teplotu
   delay_ms (500);
   altimet_a=mpl3115_A();
      
   sht25_t=SHT25_get_temp(); //mereni hodnot z SHT25
   sht25_h=SHT25_get_hum();
   
   smer_v=azimut(); //vrati azimut aktualniho smeru vetru
  
  
         delay_us(SEND_DELAY);
         putc('$');
         delay_us(SEND_DELAY);
         sprintf(output,"MST%s \0",VER);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%4.0Lu \0", poradi);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%6.2f \0", altimet_t );
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%7.2f \0", altimet_a);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%9.2f \0", altimet_p);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%6.2f \0", sht25_t);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%6.2f \0", sht25_h);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%6.2f \0", smer_v);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"%5.2f \0", anemo);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j]); check^=output[j++]; }
         sprintf(output,"*%X\r\n\0", check);
         j=0; while(output[j]!=0) { delay_us(SEND_DELAY); putc(output[j++]); }
         delay_us(SEND_DELAY);
  
  poradi++;
   restart_wdt();
  }

}