?? test_gps.c
字號:
/****************************************************************************
【文 件 名 稱】TEST_GPS.C
【功 能 描 述】三星S3C2410A板demo程序代碼
【程 序 版 本】4.0
【創建人及創建日期】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 unsigned long int strtoul(const char * /*nptr*/,
char ** /*endptr*/, int /*base*/);
char GPS_DATA1[] = { "$GPRMC,014106.350,A,2232.9727,N,11355.2626,E,0.00,,060405,,,A*7A" } ;
extern char *strncpy(char * /*s1*/, const char * /*s2*/, unsigned int num /*n*/) ;
extern double atof(const char * /*nptr*/) ;
extern char *strcpy(char * /*s1*/, const char * /*s2*/);
//***************************************************************************
GPS_INFO Gps_Infor;
//***************************************************************************
typedef struct {
U32 d; //degree
U32 c; //cent
} Position_Info;
static Position_Info Latitude, Longitude;
/****************************************************************************
【功能說明】得到指定序號的逗號位置
****************************************************************************/
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;
}
/****************************************************************************
【功能說明】
****************************************************************************/
double Get_Double_Number( char *s )
{
char buf[128];
int i;
double rev;
i = Get_Comma_Position(1,s);
strncpy( buf, s, i ) ;
buf[i] = 0 ;
rev = atof(buf) ;
printf("s=%s ,buf= %s,val= %f\n",s,buf,rev);
return rev;
}
static U32 StrToUL(char *s, int len)
{
U32 ret;
int i;
ret = 0;
for(i=0; i<len; i++) {
if(!s[i])
return ret;
if(s[i]<'0'||s[i]>'9')
return -1;
ret *= 10;
ret += s[i]-'0';
}
return ret;
}
static int Get_Position( char *s, Position_Info *p, int longi)
{
char buf[10];
memcpy(buf, s, 2+longi);
buf[2+longi] = 0;
// p->d = strtoul(buf, NULL, 10); //strtoul in ads library is error!!!
p->d = StrToUL(buf, 2+longi);
//printf("[%d %s %d] ", p->d, buf, strtoul(buf, NULL, 0));
memcpy(buf, s+2+longi, 2);
memcpy(buf+2, s+5+longi, 4);
buf[6+longi] = 0;
// p->c = strtoul(buf, NULL, 10);
p->c = StrToUL(buf, 6);
//printf("[%d %s]\n", p->c, buf);
// memcpy(buf, s, 9);
// buf[9] = 0;
// printf("Position:%d.%d %s\n", p->d, p->c, buf);
return 0;
}
/****************************************************************************
【功能說明】將世界時間轉換為北京時間
****************************************************************************/
void UTC_To_BTC(date_time *GPS)
{
//如果秒號先出,再出時間數據,則將時間數據+1秒
GPS_SEC++; //加一秒
if(GPS_SEC>59)
{
GPS_SEC=0;
GPS_MIN++;
if(GPS_MIN>59)
{
GPS_MIN=0;
GPS_HOUR++;
}
}
GPS_HOUR+=8; //小時加八
if(GPS_HOUR>23)
{
GPS_HOUR-=24;
GPS_DATE+=1;
if(GPS_MONTH==2 ||
GPS_MONTH==4 ||
GPS_MONTH==6 ||
GPS_MONTH==9 ||
GPS_MONTH==11 )
{
if(GPS_DATE>30)
{
GPS_DATE=1;
GPS_MONTH++;
}
}
else
{
if(GPS_DATE>31)
{
GPS_DATE=1;
GPS_MONTH++;
}
}
if(GPS_YEAR % 4 == 0 )
{
if(GPS_DATE > 29 && GPS_MONTH ==2)
{
GPS_DATE=1;
GPS_MONTH++;
}
}
else
{
if(GPS_DATE>28 &&GPS_MONTH ==2)
{
GPS_DATE=1;
GPS_MONTH++;
}
}
if(GPS_MONTH>12)
{
GPS_MONTH-=12;
GPS_YEAR++;
}
}
}
#define MAX_TRASH_NUM (12)
/****************************************************************************
【功能說明】解釋gps發出的數據
$GPRMC,014105.350,A,2232.9727,N,11355.2626,E,0.00,,060405,,,A*79
$GPGGA,014105.350,2232.9727,N,11355.2626,E,1,06,1.2,57.7,M,,,,0000*31
$GPGSA,A,3,28,20,08,02,23,13,,,,,,,2.0,1.2,1.6*35
$GPGSV,3,2,09,20,30,048,30,02,16,252,36,13,08,131,34,08,08,186,26*7F
****************************************************************************/
U8 GPS_Parse( char *line, GPS_INFO *GPS )
{
static int tmp ;
if( GPS_BUF[5] == 'C' )//"GPRMC"
{
GPS_HOUR = ( GPS_BUF[7]-'0' )*10 + ( GPS_BUF[8]-'0' ) ;
GPS_MIN = ( GPS_BUF[9]-'0' )*10 + ( GPS_BUF[10]-'0' ) ;
GPS_SEC = ( GPS_BUF[11]-'0' )*10 + ( GPS_BUF[11]-'0' ) ;
//printf("sec=%d ", GPS_SEC);
//*********************************************************************
tmp = Get_Comma_Position( 9, GPS_BUF ) ; //第九個逗號后面是年月日信息
GPS_DATE = ( GPS_BUF[tmp+0]-'0' )*10 + ( GPS_BUF[tmp+1]-'0' ) ;
GPS_MONTH = ( GPS_BUF[tmp+2]-'0' )*10 + ( GPS_BUF[tmp+3]-'0' ) ;
GPS_YEAR = ( GPS_BUF[tmp+4]-'0' )*10 + ( GPS_BUF[tmp+5]-'0' ) + 2000 ;
//*********************************************************************
GPS_STATUS = GPS_BUF[Get_Comma_Position(2,GPS_BUF)]; //第二個逗號后是狀態信息
//LATITUDE = Get_Double_Number( &GPS_BUF[Get_Comma_Position(3,GPS_BUF)] ); //第三個逗號后面是緯度信息
Get_Position(&GPS_BUF[Get_Comma_Position(3,GPS_BUF)], &Latitude, 0);
GPS_NS = GPS_BUF[ Get_Comma_Position(4,GPS_BUF) ]; //第四個逗號后面是北半球南半球指示信息
//LONGITUDE = Get_Double_Number( &GPS_BUF[Get_Comma_Position(5,GPS_BUF)] ); //第五個逗號后面是經度
Get_Position(&GPS_BUF[Get_Comma_Position(5,GPS_BUF)], &Longitude, 1);
GPS_EW = GPS_BUF[ Get_Comma_Position(6,GPS_BUF) ]; //第六個逗號后面是東半球西半球指示信息
#if ( USE_BEIJING_TIMEZONE )
UTC_To_BTC(&GPS->D);
#endif
//puts( "$GPRMC is OK!\n" ) ;
GPRMC = 1 ;
return 1 ;
}
else if ( GPS_BUF[5] == 'A' ) //"$GPGGA"
{
/* GPS_HOUR = ( GPS_BUF[7]-'0' )*10 + ( GPS_BUF[8]-'0' ) ;
GPS_MIN = ( GPS_BUF[9]-'0' )*10 + ( GPS_BUF[10]-'0' ) ;
GPS_SEC = ( GPS_BUF[11]-'0' )*10 + ( GPS_BUF[11]-'0' ) ;
*/ //GPS_HIGH = Get_Double_Number( &GPS_BUF[Get_Comma_Position(9,GPS_BUF)] ) ;
GPGGA = 1 ;
return 1 ;
}
return 0 ;
}
/****************************************************************************
【功能說明】
****************************************************************************/
void Show_GPS( GPS_INFO *GPS )
{
if( GPRMC == 1 )
{
if( GPS_STATUS == 'A' )
{
puts( "\nGPS DATA valid!\n" ) ;
printf("日期 : %4d-%02d-%02d \n", GPS_YEAR, GPS_MONTH, GPS_DATE ) ;
printf("時間 : %02d:%02d:%02d \n",GPS_HOUR, GPS_MIN, GPS_SEC ) ;
printf("緯度 : %d.%d %c\n", Latitude.d, Latitude.c, GPS_NS);
printf("經度 : %d.%d %c\n", Longitude.d, Longitude.c, GPS_EW);
}
else if( GPS_STATUS == 'V' )
{
puts( "GPS DATA invalid!!!\n" ) ;
printf("日期 : %4d-%02d-%02d \n", GPS_YEAR, GPS_MONTH, GPS_DATE ) ;
printf("時間 : %02d:%02d:%02d \n",GPS_HOUR, GPS_MIN, GPS_SEC ) ;
printf("緯度 : %d.%d %c\n", Latitude.d, Latitude.c, GPS_NS);
printf("經度 : %d.%d %c\n", Longitude.d, Longitude.c, GPS_EW);
}
GPRMC = 0; //clear flag
}
else if( GPGGA == 1 )
{
//printf("Highness : %.4f \n",GPS->high);
}
}
/****************************************************************************
【功能說明】串口初始化
****************************************************************************/
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(getkey()!=ESC_KEY)//( time_out-- )
{
SerialSwitch( 1 ) ; //選擇UART通道為串口1
// c = SerialRxChar(); //read from com port
c = SerialRxKey(); //read from com port
SerialSwitch( 0 ) ; //選擇UART通道為串口0
if(c)
GPS_BUF[i++] = c ;
if( c == '\n' )
{
GPS_BUF[0]='$';
GPS_BUF[i]=0;
//puts( GPS_BUF ) ;
return 1 ;
}
}
return 0 ;
}
/****************************************************************************
【功能說明】GPS模塊實驗程序
****************************************************************************/
void Test_GPS_Model( void )
{
printf( "GPS全球定位系統\n" ) ;
Uart_Initial( 1, 4800 ) ; //串口1初始化，波特率為4800
while( getkey() != ESC_KEY )
{
if( Receive_GPS() )
{
//strcpy( GPS_BUF, GPS_DATA1 ) ;
if ( GPS_Parse( GPS_BUF, &Gps_Infor ) ) ;
{
Show_GPS( &Gps_Infor ) ;
}
}
else
break;
}
}
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -