GPS度分测试程序vc6

最新推荐文章于 2022-02-20 09:50:02 发布
lainien
最新推荐文章于 2022-02-20 09:50:02 发布
阅读量321
点赞数
分类专栏：车联网仪表
本文链接：https://blog.youkuaiyun.com/coderdd/article/details/88368650
版权
车联网仪表专栏收录该内容
2 篇文章
订阅专栏
GPS度分测试程序vc6
完整代码：
// GNRMC.cpp : Defines the entry point for the console application.
//


#include "stdafx.h"
#include <string.h>
#include <stdlib.h>
#include <stdio.h>


unsigned char GPS_Info[49]={' '};
unsigned char  Mac_Id[6]={0x01,0x60,0x20,0x76,0x84,0x41};//1602078441
unsigned char Register_Info[72];

struct GNRMC_Info
{
unsigned char year;
unsigned char month;
unsigned char day;
unsigned char hour;
unsigned char Minute;
unsigned char second;


unsigned int longitude; 
unsigned char longitude_suffix; // E或W

unsigned int latitude; 
unsigned char latitude_suffix; 
unsigned char position_valid; // 有效

};
struct GNRMC_Info GNRMC;
struct China_Time
{
	unsigned char year;
	unsigned char month;
	unsigned char day;
	unsigned char hour;
	unsigned char Minute;
	unsigned char second;
};
struct China_Time Ch_TM;

void GPS_Info_Init()
{
	for(int i=0;i<49;i++)
	{
		GPS_Info[i]=0x00;
	}
	GPS_Info[0]=GPS_Info[48]=0x7e;
	GPS_Info[1]=0x02;
	GPS_Info[4]=0x22;//消息体属性
	for(int n=0;n<6;n++)
	{
		GPS_Info[n+5]=Mac_Id[n];
	}
}
void Longti_Lati_Set()
{
	unsigned char result=0x00;
	unsigned char bcd_year=0x00;
	unsigned char bcd_month=0x00;
	unsigned char bcd_day=0x00;
	unsigned char bcd_hour=0x00;
	unsigned char bcd_Minute=0x00;
	unsigned char bcd_second=0x00;
	for(int n=0;n<4;n++)
	{
		GPS_Info[n+21]=(char)(GNRMC.longitude >> ( 24 - n*8 ));
		GPS_Info[n+25]=(char)(GNRMC.latitude >> ( 24 - n*8 ));
	}
	bcd_year=(Ch_TM.year/10*16)+(Ch_TM.year%10);
	bcd_month=(Ch_TM.month/10*16)+(Ch_TM.month%10);
	bcd_day=(Ch_TM.day/10*16)+(Ch_TM.day%10);
	bcd_hour=(Ch_TM.hour/10*16)+(Ch_TM.hour%10);
	bcd_Minute=(Ch_TM.Minute/10*16)+(Ch_TM.Minute%10);
	bcd_second=(Ch_TM.second/10*16)+(Ch_TM.second%10);
	GPS_Info[35]=bcd_year;
	GPS_Info[36]=bcd_month;
	GPS_Info[37]=bcd_day;
	GPS_Info[38]=bcd_hour;
	GPS_Info[39]=bcd_Minute;
	GPS_Info[40]=bcd_second;
	
	result=GPS_Info[1];//校验码
	for(int i=2;i<=46;i++)
	{
		result^=GPS_Info[i];
	}
	GPS_Info[47]=result;
}

int comma_split(unsigned char *pstr, char *buf, int buflen, int s, int e)
{
    int i, k;
    int commaCount = 0;
    int rc = -1;
    i = k = 0;
    if (e <= s)
    {
        return -1;
    }
    while (pstr[i] != '\0')
    {
        if (pstr[i] == ',')
        {
            commaCount++;
        }
        if (commaCount == s)
        {
            k = ++i;
            break;
        }
        i++;
    }

    while (pstr[i] != '\0')
    {
        if (pstr[i] == ',')
        {
            commaCount++;
        }
        if (commaCount == e)
        {
            if (i - k + 1 > buflen)
            {
                return -1;
            }
            memset(buf, 0, sizeof(buf));
            memcpy(buf, pstr + k, i - k);

            rc = i - k;
            buf[rc] = '\0';
            //printf("%s\n", buf);
            break;
        }
        i++;
    }
    return rc;
}


int GNRMC_Parse(unsigned char *pstr, struct GNRMC_Info *pGNRMCInfo)
{
    int len = 0;
    int commaCount = 0;
    double temp = 0;
    char buf[32] = {0};
    // 计算字符串长度
    while (pstr[len] != '\0')
    {
        if (pstr[len] == ',')
        {
            commaCount++;
        }
        len++;
    }
    // 逗号个数是12个
    if (commaCount != 12)
    {
        return -1;
    }
    // 判断开始字符是:$GNRMC
    if (!((pstr[0] == '$') && (pstr[1] == 'G') && (pstr[2] == 'N') && (pstr[3] == 'R') && (pstr[4] == 'M') && (pstr[5] == 'C')))
    {
        return -1;
    }
    // 判断结束字符是:\r\n
    if ((pstr[len - 2] != '\r') && (pstr[len - 1] != '\n'))
    {
        return -1;
    }
    // UTC时间:第1个逗号与第2个逗号之前 (eg:092846.400 hhmmss.sss )
    len = comma_split(pstr, buf, sizeof(buf), 1, 2);
    if (len < 0)
    {
        return -1;
    }
    pGNRMCInfo->hour = (buf[0] - '0') * 10 + (buf[1] - '0');
    pGNRMCInfo->Minute = (buf[2] - '0') * 10 + (buf[3] - '0');
    pGNRMCInfo->second = (buf[4] - '0') * 10 + (buf[5] - '0');

    // 定位状态:第2个逗号与第3个逗号之前
    len = comma_split(pstr, buf, sizeof(buf), 2, 3);
    if (len != 1)
    {
        return -1;
    }
    pGNRMCInfo->position_valid = ((buf[0] == 'A') ? 1 : 0);

    // 经度
    len = comma_split(pstr, buf, sizeof(buf), 3, 4);
    if (len < 0)
    {
        return -1;
    }
    temp = atof(buf);
    temp = temp * 10000;
    pGNRMCInfo->longitude = temp;
    // 经度半球E(东经)或W(西经)
    len = comma_split(pstr, buf, sizeof(buf), 4, 5);
    if (len != 1)
    {
        return -1;
    }
    pGNRMCInfo->longitude_suffix = buf[0];
    // 纬度
    len = comma_split(pstr, buf, sizeof(buf), 5, 6);
    if (len < 0)
    {
        return -1;
    }
    temp = atof(buf);
    temp = temp * 10000;
    pGNRMCInfo->latitude = temp;

    // 纬度半球N(北半球)或S(南半球)
    len = comma_split(pstr, buf, sizeof(buf), 6, 7);
    if (len != 1)
    {
        return -1;
    }
    pGNRMCInfo->latitude_suffix = buf[0];

    // UTC日期:ddmmyy(日月年)格式 eg:070417
    len = comma_split(pstr, buf, sizeof(buf), 9, 10);
    if (len < 0)
    {
        return -1;
    }
    pGNRMCInfo->day = (buf[0] - '0') * 10 + (buf[1] - '0');
    pGNRMCInfo->month = (buf[2] - '0') * 10 + (buf[3] - '0');
    pGNRMCInfo->year = (buf[4] - '0') * 10 + (buf[5] - '0') ;

    return 0;
}

void UTCToChina(unsigned int UTCYear,unsigned char UTCMonth,unsigned char UTCDay,unsigned char UTCHour,unsigned char UTCMinutes,unsigned char UTCSeconds)
{
    unsigned int ChinaYear = UTCYear;
    unsigned char ChinaMonth = UTCMonth;
    unsigned char ChinaDay = UTCDay;
    unsigned char ChinaSeconds = UTCSeconds;
    unsigned char ChinaMinutes = UTCMinutes;
    unsigned char ChinaHour = UTCHour + 8;
    if (ChinaHour > 23)
    {
        ChinaHour -= 24;
        ChinaDay++;
        switch (ChinaMonth)
        {
        case 1:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 2:
            if ((0 == ChinaYear % 4 && 0 != ChinaYear % 100) || 0 == ChinaYear % 400)
            {
                if (ChinaDay > 29)
                {
                    ChinaDay = 1;
                    ChinaMonth++;
                }
            }
            else
            {
                if (ChinaDay > 28)
                {
                    ChinaDay = 1;
                    ChinaMonth++;
                }
            }
            break;
        case 3:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 4:
            if (ChinaDay > 30)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 5:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 6:
            if (ChinaDay > 30)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 7:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 8:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 9:
            if (ChinaDay > 30)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 10:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 11:
            if (ChinaDay > 30)
            {
                ChinaDay = 1;
                ChinaMonth++;
            }
            break;
        case 12:
            if (ChinaDay > 31)
            {
                ChinaDay = 1;
                ChinaMonth = 1;
                ChinaYear++;
            }
            break;
        default:
            break;
        }
    }
	Ch_TM.year=ChinaYear;
	Ch_TM.month=ChinaMonth;
	Ch_TM.day=ChinaDay;
	Ch_TM.hour=ChinaHour;
	Ch_TM.Minute=ChinaMinutes;
	Ch_TM.second=ChinaSeconds;
}

char buff[]={'$','G','N','R','M','C',',','1','3','2','2','2','2','.','0','0','0',',','A',',',
			'3','1','0','3','.','8','9','6','6',',','N',',','1','2','1','1','8','.','3','5','7',
			'1',',','E',',','1','.','6','9',',','3','2','2','.','3','9',',','1','3','0','2','1','9',
			',',',',',','A','*','7','6','\r','\n'};


unsigned char cap()
{
	unsigned char result=0x00;
	unsigned char spk[]={0x7E, 0x02 ,0x00, 0x00, 0x22, 0x54, 0x40, 0x71 ,0x46 ,0x06 ,0x70, 0x00, 0x3E, 00 ,00, 00, 00, 00, 00, 00, 02, 01, 0x58 ,
				0xE2, 0xB4, 0x06, 0xC9, 0xAD, 0xE7, 00, 0x20, 00, 00, 00, 0x5D, 0x18, 0x09, 0x27, 0x10, 0x35, 0x12, 0x01, 0x04, 00, 00, 00, 00, 0xBA, 0x7E};
	result=GPS_Info[1];//校验码
	for(int i=2;i<=46;i++)
	{
		result^=spk[i];
	}
	return result;
}

char ss[]={0x7E, 0x02 ,0x00, 0x00, 0x22, 0x54, 0x40, 0x71 ,0x46 ,0x06 ,0x70, 0x00, 0x3E, 00 ,00, 00, 00, 00, 00, 00, 02, 01, 0x58 ,
				0xE2, 0xB4, 0x06, 0xC9, 0xAD, 0xE7, 00, 0x20, 00, 00, 00, 0x5D, 0x18, 0x09, 0x27, 0x10, 0x35, 0x12, 0x01, 0x04, 00, 00, 00, 00, 0x00, 0x7E};

void verify_code(unsigned char * rp,int length)
{
	unsigned char result=0x00;
	result=rp[1];
	for(int i=2;i<length-2;i++)
	{
		result^=rp[i];
	}
	rp[length-2]=result;
}
void Register_Info_Init()
{
	for(int i=0;i<72;i++)
	{
		Register_Info[i]=0x00;
	}
	Register_Info[0]=0x7e;Register_Info[71]=0x7e;
	Register_Info[1]=0x01;Register_Info[2]=0x00;
	Register_Info[3]=0x00;Register_Info[4]=0x39;
	for(int k=0;k<6;k++)//ID
	{
		Register_Info[k+5]=Mac_Id[k];
	}
	verify_code(Register_Info,72);
}

int main(int argc, char* argv[])
{

	unsigned short heart_serial_num=0x34;
	//char* p= "$GNRMC,092846.400,A,3029.7317,N,10404.1784,E,000.0,183.8,070417,,,A*73\r\n";
	//char* p= "$GNRMC,132222.000,A,3103.8966,N,12118.3571,E,1.69,322.39,130219,,,A*76\r\n";
	GPS_Info_Init();
	//char* p= "$GNRMC,132222.000,A,3103.8966,N,12118.3571,E,1.69,322.39,130219,,,A*76\r\n";
	//GNRMC_Parse((unsigned char *)p,&GNRMC);
	GNRMC_Parse((unsigned char *)buff,&GNRMC);
	UTCToChina(GNRMC.year,GNRMC.month,GNRMC.day,GNRMC.hour,GNRMC.Minute,GNRMC.second);
	printf("%d-%d-%d %d:%d:%d\n",Ch_TM.year,Ch_TM.month,Ch_TM.day,Ch_TM.hour,Ch_TM.Minute,Ch_TM.second);
	printf("%u %c ---- %u %c 是否有效:%d\n",GNRMC.longitude,GNRMC.longitude_suffix,GNRMC.latitude,GNRMC.latitude_suffix,GNRMC.position_valid);
	
	Longti_Lati_Set();
	for(int i=0;i<49;i++)
	{
		printf("%02x",GPS_Info[i]);
	}
	printf("\r\n");printf("\r\n");
	printf("%02x",cap());
	printf("\r\n");printf("\r\n");



	Register_Info_Init();
	Register_Info[11]=(heart_serial_num & 0xFF00)>>8;
	Register_Info[12]=heart_serial_num & 0x00FF;
	verify_code(Register_Info,72);
	for(int k=0;k<72;k++)
	{
		printf("%02x",Register_Info[k]);
	}

	getchar();

	return 0;
}