stm32北斗数据解析

程序只针对MC20模块 STM32主控环境解析
gnrmc_analysis.c

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

unsigned char GPS_Info[49];
unsigned char gps_buffer[72]={'$','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'};
struct China_Time Ch_TM;
struct GNRMC_Info GNRMC;
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];
	}
}

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';
            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++;
    }
  
    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 (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');

  
    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;
}

void Longti_Lati_Set(unsigned char *pstr)
{
	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;
	GNRMC_Parse((unsigned char *)pstr,&GNRMC);
	UTCToChina(GNRMC.year,GNRMC.month,GNRMC.day,GNRMC.hour,GNRMC.Minute,GNRMC.second);
	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;
}

gnrmc_analysis.h

#ifndef _GNRMC_ANALYSIS_H_
#define _GNRMC_ANALYSIS_H_

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; 

unsigned int latitude; 
unsigned char latitude_suffix; 
unsigned char position_valid;

};


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

extern struct China_Time Ch_TM;
extern unsigned char  Mac_Id[6];
extern unsigned char GPS_Info[49];
extern unsigned char gps_buffer[72];
void GPS_Info_Init(void);
int comma_split(unsigned char *pstr, char *buf, int buflen, int s, int e);
int GNRMC_Parse(unsigned char *pstr, struct GNRMC_Info *pGNRMCInfo);
void UTCToChina(unsigned int UTCYear,unsigned char UTCMonth,unsigned char UTCDay,unsigned char UTCHour,unsigned char UTCMinutes,unsigned char UTCSeconds);
void Longti_Lati_Set(unsigned char *pstr);
#endif


主函数

/**************************************************************************************************
  Copyright (C), 2014-2017
  File name: main.c
**************************************************************************************************/
#include "stm32f30x.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <stdint.h>
#include "gnrmc_analysis.h"


unsigned char  Mac_Id[6]={0x01,0x60,0x20,0x85,0x00,0x00};//16020850000


int main(void)
{
	GPS_Info_Init();
	...//各种初始化
}


部分函数更新记录:初始化三个发送的数据

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]=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);
}	
void Heart_Info_Init()
{
	for(int i=0;i<29;i++)
	{
		Heart_Info[i]=0x00;
	}
	Heart_Info[0]=Heart_Info[28]=0x7e;
	for(int k=0;k<6;k++)//ID
	{
		Heart_Info[k+5]=Mac_Id[k];
	}
}
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];
	}
}

定期心跳包和定期GPS上传数据程序更新:

else if(System_Status==Net_Conneted)
		{
			/*switch(Net_Step)
			{
				case 1:
					if(register_serial_num++>65500)register_serial_num=0;//unsigned short
					Register_Info[11]=(register_serial_num & 0xFF00)>>8;
					Register_Info[12]=register_serial_num & 0x00FF;
					verify_code(Register_Info,72);
					Uart2_SendString("AT+QISEND=72\r\n");
					delay_ms(500);
					Uart2_SendLength(Register_Info,72);
					Uart2_SendData(0x1a);
					Clear_Buffer();
					Net_Step++;
					break;
				case 2:
					if(heart_cycle_count>=120)
					{
						heart_cycle_count=0;
						if(heart_serial_num++>65500)heart_serial_num=0;//unsigned short
						Heart_Info[11]=(register_serial_num & 0xFF00)>>8;
						Heart_Info[12]=register_serial_num & 0x00FF;
						verify_code(Heart_Info,29);
						Uart2_SendString("AT+QISEND=29\r\n");
						delay_ms(500);
						Uart2_SendLength(Heart_Info,29);
						Uart2_SendData(0x1a);
					}
					if(gps_cycle_count==5)
					{
						gps_cycle_count++;
						Uart2_SendString("AT+QGNSSRD=\"NMEA/RMC\"\r\n");
					}
					if(gps_cycle_count>10)
					{
						gps_cycle_count=0;
						if(gps_buffer[18]=='A')
						{
							if(gps_serial_num++>65500)gps_serial_num=0;//unsigned short
							GPS_Info[11]=(gps_serial_num & 0xFF00)>>8;
							GPS_Info[12]=gps_serial_num & 0x00FF;
							Longti_Lati_Set(gps_buffer);
							Uart2_SendString("AT+QISEND=49\r\n");
							delay_ms(500);
							Uart2_SendLength(GPS_Info,49);
							Uart2_SendData(0x1a);
							gps_buffer[18]=' ';
						}
					}
					break;
				case 3:
					break;
				case 4:
					break;
				default:
					break;
			}*/
评论 2
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值