/****************************************************************************
【文  件  名  稱】TEST_GPS.C
【功  能  描  述】三星S3C2410A板demo程序代碼
【程  序  版  本】4.0
【創(chuàng)建人及創(chuàng)建日期】icesoar//2003年11月19日19:26
【修改人及修改日期】icesoar//2004-12-8 17:25
****************************************************************************/

//***************************************************************************
#include "def.h"
#include "2410addr.h"
#include "config.h"
#include "board.h"
#include "utils.h"
#include "GPS.h"

extern double atof(const char * /*nptr*/) ;
//***************************************************************************
GPS_INFO Gps_Infor;
char GPS_BUF[1024];
//***************************************************************************

/****************************************************************************
【功能說明】得到指定序號(hào)的逗號(hào)位置
****************************************************************************/
static int Get_Comma_Position( int num,char *str )
{
	int i,j = 0 ;
	int len = strlen(str) ;
	for( i = 0; i < len; i++ )
	{
		if( str[i] == ',' )		j++ ;
		if( j == num )		return (i+1) ;	
	}
	
	return 0;	
}

/****************************************************************************
【功能說明】
****************************************************************************/
static double Get_Double_Number( char *s )
{
	char buf[128];
	int i;
	double rev;
	i = Get_Comma_Position(1,s);
	memcpy( buf, s, i );		//strncpy(buf,s,i);
	buf[i]=0;
	rev = atof(buf) ;
//	printf("s=%s ,buf= %s,val= %f\n",s,buf,rev);
	return rev;
	
}

/****************************************************************************
【功能說明】將世界時(shí)間轉(zhuǎn)換為北京時(shí)間
****************************************************************************/
static void UTC_To_BTC(date_time *GPS)
{
//如果秒號(hào)先出,再出時(shí)間數(shù)據(jù),則將時(shí)間數(shù)據(jù)+1秒
	GPS->second++; //加一秒
	if(GPS->second>59)
	{
		GPS->second=0;
		GPS->minute++;
		if(GPS->minute>59)
		{
			GPS->minute=0;
			GPS->hour++;
		}
	}	

	GPS->hour+=8;
	if(GPS->hour>23)
	{
		GPS->hour-=24;
		GPS->day+=1;
		if(GPS->month==2 ||
	   		GPS->month==4 ||
	   		GPS->month==6 ||
	   		GPS->month==9 ||
	   		GPS->month==11 )
	   	{
			if(GPS->day>30)
			{
				GPS->day=1;
				GPS->month++;
			}
		}
		else
		{
			if(GPS->day>31)
			{
				GPS->day=1;
				GPS->month++;
			}
		}
		
		if(GPS->year % 4 == 0 )
		{
			if(GPS->day > 29 && GPS->month ==2)
			{
		   		GPS->day=1;
				GPS->month++;
			}
		}
		else
		{
			if(GPS->day>28 &&GPS->month ==2)
			{
		   		GPS->day=1;
				GPS->month++;
			}
		}

		if(GPS->month>12)
		{
			GPS->month-=12;
			GPS->year++;
		}		
	}
}

#define MAX_TRASH_NUM	(12)
/****************************************************************************
【功能說明】解釋gps發(fā)出的數(shù)據(jù)

//0      7  0   4 6   0     6 8 0        90         0  3      0        9  	
//$GPRMC,091400,A,3958.9870,N,11620.3278,E,000.0,000.0,120302,005.6,W*62	
//$GPGGA,091400,3958.9870,N,11620.3278,E,1,03,1.9,114.2,M,-8.3,M,,*5E	
****************************************************************************/
void GPS_Parse( char *line, GPS_INFO *GPS )
{
	static int tmp ;
	char *buf = line;
	char c = buf[5] ;

	if( c=='C' )//"GPRMC"
	{
		GPS->D.hour   =(buf[ 7]-'0')*10+(buf[ 8]-'0');
		GPS->D.minute =(buf[ 9]-'0')*10+(buf[10]-'0');
		GPS->D.second =(buf[11]-'0')*10+(buf[12]-'0');
		tmp = Get_Comma_Position(9,buf);
		GPS->D.day    =(buf[tmp+0]-'0')*10+(buf[tmp+1]-'0');
		GPS->D.month  =(buf[tmp+2]-'0')*10+(buf[tmp+3]-'0');
		GPS->D.year   =(buf[tmp+4]-'0')*10+(buf[tmp+5]-'0')+2000;
		//------------------------------
		GPS->status	  =buf[Get_Comma_Position(2,buf)];
		GPS->latitude =Get_Double_Number(&buf[Get_Comma_Position(3,buf)]);
		GPS->NS       =buf[Get_Comma_Position(4,buf)];
		GPS->longitude=Get_Double_Number(&buf[Get_Comma_Position(5,buf)]);
		GPS->EW       =buf[Get_Comma_Position(6,buf)];
		
		#ifdef USE_BEIJING_TIMEZONE
				UTC_To_BTC(&GPS->D);
		#endif
	}
	
	if ( c == 'A' ) //"$GPGGA"
	{
		GPS->high = Get_Double_Number(&buf[Get_Comma_Position(9,buf)]);
	}
}

/****************************************************************************
【功能說明】
****************************************************************************/
void Show_GPS( GPS_INFO *GPS )
{
	printf("DATE       : %ld-%02d-%02d \n",GPS->D.year,GPS->D.month,GPS->D.day);
	printf("TIME       :  %02d:%02d:%02d \n",GPS->D.hour,GPS->D.minute,GPS->D.second);
	printf("Latitude   : %.4f %c\n",GPS->latitude,GPS->NS);	
	printf("Longitude  : %.4f%c\n",GPS->longitude,GPS->EW);	
	printf("Highness   : %.4f \n",GPS->high);	
	printf("STATUS     : %c\n",GPS->status);	
}

/****************************************************************************
【功能說明】串口初始化
****************************************************************************/
void Uart_Initial( U8 uart, U16 baud )
{
	U32 mclk =  GetMasterClock();
	
	if( uart == 0 )
	{
		//UART0
		rUFCON0 = 0x0;		//FIFO disable
		rUMCON0 = 0x0;
		rULCON0  = 0x3;		//Normal,No parity,1 stop,8 bit
		rUCON0   = 0x245;	//rx=edge,tx=level,disable timeout int.,enable rx error int.,normal,interrupt or polling
		rUBRDIV0 = ((int)(mclk/16./baud + 0.5) -1);
	}
	else if( uart == 1 )
	{
		//UART1
		rUFCON1 = 0x0;		//FIFO disable
		rUMCON1 = 0x0;
		rULCON1  = 0x3;
		rUCON1   = 0x245;
		rUBRDIV1 = ((int)(mclk/16./baud + 0.5) -1);
	}
}

/****************************************************************************
【功能說明】接收GPS模塊的信息輸入
****************************************************************************/
U8 Receive_GPS( void )
{
	int i = 0 ;
	char c ;
	U32 time_out = 500000 ;

    while( time_out-- )
	{
		SerialSwitch( 1 ) ;		//選擇UART通道為串口1
	    c = SerialRxChar();		//read from com port
		SerialSwitch( 0 ) ;		//選擇UART通道為串口0
		GPS_BUF[i++] = c ;
		
		if( c == '\n' )
		{
			GPS_BUF[0]='$';				
			GPS_BUF[i]=0;
			printf( "\n%s\n", GPS_BUF ) ;
			return 1 ;
		}
  	}
  	
  	return 0 ;	
}

/****************************************************************************
【功能說明】GPS模塊測(cè)試程序
****************************************************************************/
void Test_GPS_Model( void )
{
	printf( "GPS全球定位系統(tǒng)\n" ) ;
	Uart_Initial( 1, 4800 ) ;		//串口1初始化，波特率為4800
	
    while( getkey() != ESC_KEY )
	{
		if( Receive_GPS() )
		{
			GPS_Parse( GPS_BUF, &Gps_Infor ) ;
			//Show_GPS( &Gps_Infor ) ;
		}
	}
}

static char title[] = "GPS測(cè)試";
static char tip[]   = "測(cè)試GPS全球定位系統(tǒng),按ESC鍵返回";

//Test_GPS_ModelItem在prog_entry.c里被引用
TEST_PROGRAM_ITEM Test_GPS_ModelItem = {
				(TEST_PROGRAM)Test_GPS_Model, 	//入口地址
				title, 					//顯示名稱
				tip, 					//幫助或提示信息,可為NULL
				0};						//使用printf,puts,putch等函數(shù)時(shí)在LCD上也顯示輸出字符(串)