#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)

#include "mylcd.c"

void main()
{
char odp[8];
int pom,pom2,pom3,odkl,odkl2,maskovadlo;

   setup_adc_ports(NO_ANALOGS);
   setup_adc(ADC_OFF);
   setup_psp(PSP_DISABLED);
   setup_spi(SPI_SS_DISABLED);
   setup_timer_0(RTCC_INTERNAL|RTCC_DIV_1);
   setup_timer_1(T1_DISABLED);
   setup_timer_2(T2_DISABLED,0,1);
   setup_comparator(NC_NC_NC_NC);
   setup_vref(FALSE);
   lcd_init();
   
   while(TRUE)
   {
    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);
    
   printf("AT+CMGL=0\r");           //vycti prijate SMS
   gets(odp);                       //uloz odpoved prikazu do odp
   getc();                          //preskoc 0A
   getc();                          //preskoc 0D
   gets(odp);                       //uloz pocatek odpovedi do odp
  
   if(odp[0] == 79 && odp[1] ==75)
   {
   lcd_gotoxy(1,1);
   printf(lcd_putc,"\fNeni nova SMS zprava!");
   lcd_gotoxy(1,2);
   printf(lcd_putc,"");
   lcd_gotoxy(1,3);
   printf(lcd_putc,"Zaslete SMS na cislo");
   lcd_gotoxy(1,4);
   printf(lcd_putc,"    736 655 250");
   delay_ms(5000);
   }else
   {
   
   for(pom=0;pom<55;pom++)                //preskoc nedulezite informace
   {
   getc();
   }
   gets(odp);                       //uloz zakodovany text SMS
   
   /*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]="";
   
   /*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'; 
    /*lcd_gotoxy(1,3);
    printf(lcd_putc,"%u %u %u %u",odp[0],odp[1],odp[2]odp[3]);   */
    lcd_gotoxy(1,2);
    printf(lcd_putc,"Prijata SMS s textem",);
    lcd_gotoxy(9,3);
    printf(lcd_putc,"%s",odp); 
    output_low(PIN_A4) ;
    delay_ms(30000);
    output_high(PIN_A4);
    printf("AT+CMGD=1\r");          //smaz prijatou SMSku
   }
 }
}