#include <reg52.h>
#include <absacc.h>
#include <intrins.h>
#include <header.h>
#include <math.h>
#define D_PORT        P0
sbit RS                =P2^0;
sbit RW                =P2^1;
sbit E                =P2^2;
#define         LCD_BUS         P0
#define LCD_COMMAND                        0      
#define LCD_DATA                        1     
unsigned char data GPS_buffer[60];
unsigned char  xdata GPS_Data_num=0;
unsigned char data GPS_utc_buffer[7];
unsigned char  xdata GPS_utc_len=0;
unsigned char xdata GPGRS_datalen[12];  
unsigned char  xdata comma_number= 0;
unsigned char  xdata sv_status_flag=0;
unsigned char  data display_square_error[6]=0;
GPS_DATA_SH xdata posdata_shu;
void wait_free()
{
        unsigned char retb;
        do{
         D_PORT=0xff;
         E=1;
         retb=D_PORT;
        }while((retb&0x80)!=0);
}
void write_comm(unsigned char cmd_dat,bit cd)
{
        wait_free();
         if(cd)RS=1;
         else RS=0;
         RW=0;
         E=1;
         D_PORT=cmd_dat;
}
void LCD_SetInput(unsigned char InputMode)
{
        write_comm( 0x04|InputMode,0);
}
void LCD_SetDisplay(unsigned char DisplayMode)
{
        write_comm(0x08|DisplayMode,0);        
}
void delay()
{
        unsigned int i,k;
        for(i=0;i<100;i++)
        for(k=0;k<100;k++);
}
void GotoXY(unsigned char x, unsigned char y)
{
        if(y==0)
                write_comm(0x80|x,LCD_COMMAND);
        if(y==1)
                write_comm(0x90|x,LCD_COMMAND);
}
void Print(unsigned char *str,unsigned char len)
{
   unsigned char i;
        for(i=0;i<len;i++)
        {
               write_comm(*str++,1);
        }
}
void LCD_ShowString(unsigned char line, unsigned char col, unsigned char *str,unsigned char len)
{   
   GotoXY(col,line);
   Print(str,len);
}
void seria0() interrupt 4 using 2
{
    unsigned char data  RcvChar;
        unsigned char data dataHeader[6]="$GPGRS";
        if(RI)
        {
          RI = 0 ;
                 RcvChar=SBUF;
            if(!posdata_shu.ful)
         {
                         if(posdata_shu.check >=6  )
                     {
               if(RcvChar!=0x0a)
                                {        P1=0xf8;
                                                *(posdata_shu.buf+posdata_shu.off) = RcvChar;
                                                posdata_shu.off ++;
                                        }
                else
                  {
                                        P1=0xf8;
                                                posdata_shu.ful = 1;
                                                posdata_shu.val = 1;
                                                posdata_shu.check = 0;
                                        }
              }   
           else
                {
                        if(*(dataHeader+posdata_shu.check) == RcvChar)
                                            {        posdata_shu.check++;
                                            }
                                        else
                                       {
                                            posdata_shu.check= 0;
                                            posdata_shu.off = 0 ;
                                       }
                         }
                        }
                        else
                          {
                             ;
                          }
      }
}
void sv_status(unsigned char sv_number,float sv_sseerror)
{
  unsigned char sv_status_temp;
  switch(sv_number)
  {
    case 5:
              if(sv_sseerror>31.960)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                  break;
     case 6:
              if(sv_sseerror>24.088)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                   break;
         case 7:
              if(sv_sseerror>20.612)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                   break;
         case 8:
              if(sv_sseerror>18.551)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                   break;
         case 9:
              if(sv_sseerror>17.153)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                   break;
         case 10:
              if(sv_sseerror>16.125)
                  {
                   sv_status_temp=0x55;
                  }
     case 11:
              if(sv_sseerror>15.331)
                  {
                   sv_status_temp=0x55;
                  }
                  else
                  {
                   sv_status_temp=0xaa;
                  }
                   break;
          case 12:
              if(sv_sseerror>14.693)
                  {
                   sv_status_temp=0x55;
                   }
                   break;
  }
  sv_status_flag=sv_status_temp;
}
//////////////////////////////////////////////////////////////
unsigned char *get_in_gps(unsigned char *paddr,unsigned char n)
{
        unsigned char *return_p;
        unsigned char i=0;
        return_p = paddr;
        while(1)
        {
                if(*return_p == ',')
                {
                        i++;
                }
                return_p++;
                if(i == n)
                {
                        break;
                }
        }
        return return_p;
}
unsigned char convertdata(unsigned char ch)
{
        if((ch>=0x30) &&(ch<=0x39))
                return (ch-0x30);
        if((ch>=0x41) &&(ch<=0x5a))
                return (ch-0x41+0x0a);
        if((ch>=0x61)&&(ch<=0x7a))
                return(ch-0x61+0x0a);
        return 0;
}
char GPS_Data_verify(unsigned char *paddr,unsigned char len)         
{
        unsigned char comma = 0;
        unsigned char i;
        unsigned char index= 0;
        unsigned char index1= 0;
    unsigned char hour;
        unsigned char *pdat;
        unsigned char crc = 0x4b;
        unsigned char temp1;
        unsigned char temp2;
        unsigned char *pdat_buffer;
        pdat_buffer=paddr;
   for(i=0;i<len;i++)
        {
           temp1=*pdat_buffer;
           temp2=*(pdat_buffer+1);
                if((*pdat_buffer ==',')&&(*(pdat_buffer+1)!=','))
                {
                 comma_number++;
                }
                 pdat_buffer++;
        }
        comma_number=comma_number-3;
        pdat = get_in_gps(paddr, 1);
        for(i=0;i<6;i++)
        {
                GPS_utc_buffer[index1++] = *(pdat+i);
                GPS_utc_len++;
        }
        hour = (*pdat-0x30)*10+*(pdat+1)-0x30;
        hour +=8;
        hour %=24;
        *pdat = hour/10+0x30;
        *(pdat+1) = hour%10+0x30;
        for(i=0;i<6;i++)
        {
                GPS_buffer[index++] = *(pdat+i);
        }
    for(i=0;i<comma_number;i++)
        {
      pdat = get_in_gps(paddr,(3+i));
         while(*pdat !=',')
         {
           if(*pdat=='-')
           {
                     pdat++;
           }
           else
           {
                GPS_buffer[index++] = *pdat;
                pdat++;
                GPGRS_datalen++;
                }
          }
        }

        GPS_Data_num=index;
        return index;
}
void gps_data_convert(void)
{
        unsigned char err_flag=0;
        unsigned char i=0;
    unsigned char index=0;
        float range_error[12];
        float squre_error=0;
        float sse_error=0;
    float squre_error_yushu=0;
        unsigned char squre_integer=0;
        unsigned char squre_integer_high=0;
    unsigned char squre_integer_low=0;
        unsigned int squre_temp=0;
        unsigned char squre_decimal_inte1=0;
    unsigned char squre_decimal_yushu=0;
        unsigned char squre_decimal_inte2=0;
        unsigned char squre_decimal_inte3=0;
        if(posdata_shu.val==1)
                {
                        P1=0xfa;
                posdata_shu.val=0;
                  err_flag = GPS_Data_verify(posdata_shu.buf,posdata_shu.off);
                if(err_flag== -1)
                {
                  P1=0xfb;
                        posdata_shu.ful = 0;
                        posdata_shu.off=0;
                        return;
                }
                else if(err_flag ==0)
                {        P1=0xfc;;
                        
                        posdata_shu.ful = 0;
                        posdata_shu.val = 0;
                        posdata_shu.off=0;
                        return;
                }
             index=6;
         for(i=0;i<comma_number;i++)
                  {
                    if(GPGRS_datalen==4)
                           {
                            range_error=((convertdata(GPS_buffer[index]))*10+convertdata(GPS_buffer[index+1])+(convertdata(GPS_buffer[index+3]))*0.1);
                                index=index+4;
                           }
                        else if (GPGRS_datalen==3)
                            {
                                 range_error=(convertdata(GPS_buffer[index])+convertdata(GPS_buffer[index+2])*0.1);
                                 index=index+3;
                                }
                   squre_error=squre_error+range_error*range_error;
                  }      
       sse_error=sqrt(squre_error/(comma_number-4));   
              squre_integer=(int)sse_error;
           if(squre_integer>9)
           {
            squre_integer_high=squre_integer/10;
                squre_integer_low=squre_integer%10;
                display_square_error[0]=squre_integer_high|0x30;
           }
           else
           {
        squre_integer_high=0;
                squre_integer_low=squre_integer;
                display_square_error[0]=0x20;
           }
       ////////////////////////////////////////////////
       squre_error_yushu=sse_error-squre_integer;
       squre_temp=squre_error_yushu*1000;
       squre_decimal_inte1=squre_temp/100;
       squre_decimal_yushu=squre_temp%100;
       squre_decimal_inte2=squre_decimal_yushu/10;
       squre_decimal_inte3=squre_decimal_yushu%10;
       display_square_error[1]=squre_integer_low|0x30;
       display_square_error[2]='.';
           display_square_error[3]=squre_decimal_inte1|0x30;
       display_square_error[4]=squre_decimal_inte2|0x30;
       display_square_error[5]=squre_decimal_inte3|0x30;
           ///////////////////////////////////////////////////
       sv_status(comma_number,sse_error);
        //////////////////////////////////////////////
                        P1=0xfd;;
                posdata_shu.val = 1;        
                }
    else
      {
           ;
      }
}
void main(void)
{        
        unsigned char   i;
        //unsigned char j,k;
        //unsigned char temp;
    serial_init();
    pps_init();
    delay();
         delay();
         delay();
     delay();
         delay();
         delay();
     write_comm(0x30,0);
         delay();
          delay();
     write_comm(0x30,0);
         delay();
     delay();
         delay();
         write_comm(0x0C,0);
         delay();
         delay();
         write_comm(0x01,0);
     delay();
          delay();
          delay();
          delay();
          delay();
      write_comm(0x06,0);
          delay();
          delay();
    EA = 1;        
                P1=0xf8;
                        posdata_shu.check= 0;
                                            posdata_shu.off = 0 ;
                                                posdata_shu.ful = 0;
                                                        posdata_shu.val=0;
for(i=0;i<12;i++)
{
GPGRS_datalen=0;
}
for(i=0;i<5;i++)
{
display_square_error=0;
}
   while(1)
       {
                 gps_data_convert();
                  if (posdata_shu.val==1)
                  {
                            P1=0xf8;
                      for(i=0;i<posdata_shu.off;i++)
               {        TI=0;
                             SBUF=*(posdata_shu.buf+i);
                                        *(posdata_shu.buf+i)=0;
                                 while(TI==0);
                                        TI=0;
                         }
                           posdata_shu.val=0;
                        posdata_shu.ful = 0;
                        posdata_shu.off=0;
                        LCD_ShowString(0,4,display_square_error,6);
                        LCD_ShowString(0,7,"米",2);
                        if(sv_status_flag==0xaa)
                        {
                         LCD_ShowString(1,5,"无故障",6);
                         }
                        else if(sv_status_flag==0x55)
                        {
              LCD_ShowString(1,5,"有故障",6);
                        }
                         for(i=0;i<5;i++)
             {
               display_square_error=0;
                }
                                           comma_number=0;
           for(i=0;i<12;i++)
           {
           GPGRS_datalen=0;
       }
                   }
                LCD_ShowString(0,0,"伪距SSE:",8);
                 LCD_ShowString(1,0,"监测结果:",9);
                }
}
//header.h
void serial_init()         
{SCON  = 0x50;
TMOD |= 0x20;
TH1 = TL1 = 0XFD;  
TR1   = 1;
PS = 1 ;
ES = 1;
PCON = 0x00; }
void pps_init()     
{IT1 = 1;
EX1 = 1; }                                                                                                                                                   
typedef struct
{
                unsigned char check;
                unsigned char off;
                unsigned char val;
                unsigned char ful;
                unsigned char buf[80];
}GPS_DATA_SH;