#include ".\main.h"

#define LCD_RS          PIN_B1      // rizeni registru LCD displeje
#define LCD_E           PIN_B0      // enable LCD displeje
#define LCD_DATA_LSB    PIN_C0      // pripojeni LSB bitu datoveho portu LCD displeje (celkem 4 bity vzestupne za sebou)


#bit SPEN=0x18.7
#bit RCIF=0x0C.5

#include <stdio.h>
#include <string.h>
#include <stdlib.h>

#define DELKA  40

char odp[DELKA];

int1 check_new_sms()
{
   fprintf(MOBIL,"AT+CMGL=1\r");           //vycti prijate SMS (0=nove;1=vsechny)
   while(fgetc(MOBIL)!=0x0A);       // predkoc prvni radek odpovedi
   odp[0]=fgetc(MOBIL);             // Nacti prvni dva znaky druheho radku odpovedi
   odp[1]=fgetc(MOBIL);
   while(fgetc(MOBIL)!=0x0A);       // Preskoc zbytek radku

   if(odp[0] == 'O' && odp[1] == 'K') return 1;
   else return 0;
}

read_sms()
{
int pom,pom2,pom3,odkl,odkl2,maskovadlo;
      for(pom=0;pom<54;pom++)                //preskoc nedulezite informace
      {
         fgetc(MOBIL);
      }

      //gets(odp);                       //uloz zakodovany text SMS

      odp[0]=fgetc(MOBIL);
      odp[1]=fgetc(MOBIL);
      odp[2]=fgetc(MOBIL);
      odp[3]=fgetc(MOBIL);
      odp[4]=fgetc(MOBIL);
      odp[5]=fgetc(MOBIL);
      odp[6]=fgetc(MOBIL);
      odp[7]=fgetc(MOBIL);

      /*lcd_gotoxy(1,1);
      printf(lcd_putc,"\f%s\n",odp);*/

      if(odp[0]==0) odp[1]='0';        // Prevod z ASCII do BIN
      odp[0]=odp[0] - '0';
      odp[1]=odp[1] - '0';
      if(odp[0]>9) odp[0]=odp[0]-7;
      if(odp[1]>9) odp[1]=odp[1]-7;
      odp[0]=odp[0] << 4;
      odp[0] |= odp[1];

      if(odp[2]==0) odp[3]='0';
      odp[2]=odp[2] - '0';
      odp[3]=odp[3] - '0';
      if(odp[2]>9) odp[2]=odp[2]-7;
      if(odp[3]>9) odp[3]=odp[3]-7;
      odp[2]=odp[2] << 4;
      odp[2] |= odp[3];

      if(odp[4]==0) odp[5]='0';
      odp[4]=odp[4] - '0';
      odp[5]=odp[5] - '0';
      if(odp[4]>9) odp[4]=odp[4]-7;
      if(odp[5]>9) odp[5]=odp[5]-7;
      odp[4]=odp[4] << 4;
      odp[4] |= odp[5];

      if(odp[6]==0) odp[7]='0';
      odp[6]=odp[6] - '0';
      odp[7]=odp[7] - '0';
      if(odp[6]>9) odp[6]=odp[6]-7;
      if(odp[7]>9) odp[7]=odp[7]-7;
      odp[6]=odp[6] << 4;
      odp[6] |= odp[7];

      odp[1]=odp[2];
      odp[2]=odp[4];
      odp[3]=odp[6];
      odp[4]=odp[5]=odp[6]=0;

      /*lcd_gotoxy(1,2);
      printf(lcd_putc,"%u %u %u %u",odp[0],odp[1],odp[2]odp[3]);   */

      pom3=0;
      for (pom = 0; pom < 4;pom++)
         {
         maskovadlo =  maskovadlo >> 1;                 //rotace promene urcene pro maskovani
         maskovadlo =  maskovadlo | 0x80;
         odkl = odp[pom] & maskovadlo;                  //odlozeni "prenosu" do odkl pomoci maskovadla
         odp[pom] = odp[pom] << pom3;                     //rotace znaku
         for (pom2 = 0; pom2 < (8-pom3);pom2++)            //rotace odkl2
            {
            odkl2 = odkl2 >> 1;
            odkl2 = odkl2 & 127;
            }
         odp[pom] = odp[pom] | odkl2;                     //pridani odkl2 ke znaku
         odp[pom] = odp[pom] & 127;                      //smazani nejvysiho bitu
         odkl2 = odkl;                              //ulozeni odlk na dalsi pruchod
         pom3++;                                    //inkrementace citace rotace
         if (pom3 == 8)                              //kazdy 8my znak
            {
            pom3 = 0;                                 //smaz citac
            odp[pom+1] = odkl2;                        //uloz 8my znak vznikly z "prenosu"
            maskovadlo = 0;                           //smaz maskovadlo
            }
         }
         odp[pom]='\0';
}

void read_time()
{
unsigned int8 n;


   fprintf(MOBIL,"AT+CCLK?\r");
   while(fgetc(MOBIL)!='"');
   for(n=0;n<12;n++)                //preskoc nedulezite informace
   {
         fgetc(MOBIL);
   }
   odp[0]=fgetc(MOBIL);
   odp[1]=fgetc(MOBIL);
   odp[2]=0;
}

void del_sms()
{
   fprintf(MOBIL,"AT+CMGD=1\r");          //smaz prijatou SMSku
}

void main()
{
   setup_adc_ports(NO_ANALOGS);
   setup_adc(ADC_OFF);
   setup_spi(SPI_SS_DISABLED);
   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
   setup_timer_1(T1_DISABLED);
   setup_timer_2(T2_DIV_BY_4,255,1);
   setup_ccp1(CCP_PWM);
   setup_ccp2(CCP_PWM);
   setup_comparator(NC_NC_NC_NC);
   setup_vref(FALSE);
   setup_wdt(WDT_2304MS);

   set_pwm1_duty(0);
   set_pwm2_duty(0);

   while(TRUE)
   {
int status;
char *ptr;
int time;

    restart_wdt();

    output_low(PIN_A4) ;
    delay_ms(150);
    output_high(PIN_A4);
    delay_ms(150);
    output_low(PIN_A4) ;
    delay_ms(150);
    output_high(PIN_A4);
    delay_ms(150);


          set_pwm1_duty(500);
          set_pwm2_duty(500);

          fprintf(VRTULE,"ABABABABAB");


/*   if(check_new_sms())   // Je odpoved "OK"?
   {
//      printf(lcd_putc,"736 655 250");
      delay_ms(1000);
   }
   else
   {
    read_sms();

      if (odp[0] == 'A' || odp[0] == 'a')
      {
          set_pwm1_duty(500);
          set_pwm2_duty(500);
          Delay_ms(5000);
          fprintf(VRTULE,"ABABABABAB");
          Delay_ms(20000);
          set_pwm1_duty(0);
          set_pwm2_duty(0);
      }

      if (odp[0] == 118 && odp[1] == 121 && odp[2] == 112 && odp[3]== 49)
         {
         fprintf(VRTULE,"");
         }

      if (odp[0] == 97 && odp[1] == 104 && odp[2] == 111 && odp[3]== 106)
         {
         fprintf(VRTULE,"");
         }
   }
/*      read_time();
      time=strtoul(odp,&ptr,10);
      if((time >= 30 && time <= 35) || (time >= 0 && time <= 5))
      {
        set_pwm1_duty(500);
        set_pwm2_duty(500);
      }
      else
      {
         set_pwm1_duty(0);
         set_pwm2_duty(0);
      }*/

      delay_ms(1000);
 }
}