?? test_gps.cbackup2
字號:
/****************************************************************************
【文 件 名 稱】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 char *strncpy(char * /*s1*/, const char * /*s2*/, unsigned int num /*n*/) ;
extern double atof(const char * /*nptr*/) ;
//***************************************************************************
GPS_INFO Gps_Infor;
char GPS_BUF[1024];
//***************************************************************************
/****************************************************************************
【功能說明】得到指定序號的逗號位置
****************************************************************************/
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);
strncpy( buf, s, i ) ;
buf[i] = 0 ;
rev = atof(buf) ;
printf("s=%s ,buf= %s,val= %f\n",s,buf,rev);
return rev;
}
/****************************************************************************
【功能說明】將世界時間轉(zhuǎn)換為北京時間
****************************************************************************/
static void UTC_To_BTC(date_time *GPS)
{
//如果秒號先出,再出時間數(shù)據(jù),則將時間數(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ù)
$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
$GPRMC,014105.350,A,2232.9727,N,11355.2626,E,0.00,,060405,,,A*79
$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, time ;
char c ;
char *buf = line ;
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)];
#if ( USE_BEIJING_TIMEZONE )
UTC_To_BTC(&GPS->D);
#endif
return 1 ;
}
else if ( c == 'A' ) //"$GPGGA"
{
GPS->high = Get_Double_Number(&buf[Get_Comma_Position(9,buf)]);
return 1 ;
}
return 0 ;
}
/****************************************************************************
【功能說明】
****************************************************************************/
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;
puts( GPS_BUF ) ;
return 1 ;
}
}
return 0 ;
}
/****************************************************************************
【功能說明】GPS模塊測試程序
****************************************************************************/
void Test_GPS_Model( void )
{
printf( "GPS全球定位系統(tǒng)\n" ) ;
Uart_Initial( 1, 4800 ) ; //串口1初始化，波特率為4800
while( getkey() != ESC_KEY )
{
if( Receive_GPS() )
{
if ( GPS_Parse( GPS_BUF, &Gps_Infor ) ) ;
{
Delay( 10 ) ; //Delay some time
Show_GPS( &Gps_Infor ) ;
Delay( 20 ) ; //Delay some time
}
}
}
}
static char title[] = "GPS測試";
static char tip[] = "測試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ù)時在LCD上也顯示輸出字符(串)
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -