C语言-GPS经纬度数据提取

一帧数据：

const char input[1024] ="$GNGGA,084852.000,2236.9453,N,11408.4790,E,1,05,3.1,89.7,M,0.0,M,,*48 $GNGLL,2236.9453,N,11408.4790,E,084852.000,A,A*4C $GPGSA,A,3,10,18,31,,,,,,,,,,6.3,3.1,5.4*3E $BDGSA,A,3,06,07,,,,,,,,,,,6.3,3.1,5.4*24 $GPGSV,3,1,09,10,78,325,24,12,36,064,,14,26,307,,18,67,146,27*71 $GPGSV,3,2,09,21,15,188,,24,13,043,,25,55,119,,31,36,247,30*7F $GPGSV,3,3,09,32,42,334,*43 $BDGSV,1,1,02,06,68,055,27,07,82,211,31*6A $GNRMC,084852.000,A,2236.9453,N,11408.4790,E,0.53,292.44,141216,,,A*7 5$GNVTG,292.44,T,,M,0.53,N,0.98,K,A*2D $GNZDA,084852.000,14,12,2016,00,00*48 $GPTXT,01,01,01,ANTENNA OK*35";

提取格式：

代码：

//GPS经纬度数据提取 
#include<stdio.h>
#include<string.h>
const char input[1024] ="$GNGGA,084852.000,2236.9453,N,11408.4790,E,1,05,3.1,89.7,M,0.0,M,,*48 $GNGLL,2236.9453,N,11408.4790,E,084852.000,A,A*4C $GPGSA,A,3,10,18,31,,,,,,,,,,6.3,3.1,5.4*3E $BDGSA,A,3,06,07,,,,,,,,,,,6.3,3.1,5.4*24 $GPGSV,3,1,09,10,78,325,24,12,36,064,,14,26,307,,18,67,146,27*71 $GPGSV,3,2,09,21,15,188,,24,13,043,,25,55,119,,31,36,247,30*7F $GPGSV,3,3,09,32,42,334,*43 $BDGSV,1,1,02,06,68,055,27,07,82,211,31*6A $GNRMC,084852.000,A,2236.9453,N,11408.4790,E,0.53,292.44,141216,,,A*7 5$GNVTG,292.44,T,,M,0.53,N,0.98,K,A*2D $GNZDA,084852.000,14,12,2016,00,00*48 $GPTXT,01,01,01,ANTENNA OK*35";

//字符串长度计算
int str_len(char *s)
{
	int i=0;
	//for(i = 0; s[i] != '\0' ++i);
	while(1)
	{
		if(s[i]=='\0')
			break;
	i++;
	}
	return i;
}

//字符串查找
int find_str(char *buff,char *c)
{
	int i =0,j=0,num=0;
	int flag=0,buff_len;
	buff_len=str_len(buff);
	printf("字符串总长度为：%d",buff_len);
	for(i=0;i<buff_len;i++)
	{
		if(c[0] == buff[i])
		{
			//printf("找到一个%d\n",i);
			for(j=0;c[j]!='\0';j++)
			{
				
				if(c[j] == buff[i+j])
				{	
					flag=i;
				}	
				else
					flag =-1;
			}
		}
		if(flag >0)
			return flag;
	}
	
}


//在字符串中查找字符并返回位置 
char *find(char *buff,char *c,int ret)
{
	int i =0;
	
	for(i=ret;i<ret+50;i++)
	{
		if(buff[i]==c)
			return i;//&buff[i];
	}
	return 0;
}
//字符串复制

int main()
{
	//printf("gpsdata=%s",input);
	int place,i,ret;
    char b[100] = "$GPRMC";

	ret=find_str(input,b);//返回字符串位置 
    printf("字符串首位于: %d\n", ret);
    
    int p1,p2,p3,p4;
    
    p1=find(input,'A',ret+6);//+6是跳过"$GPRMC"
    p2=find(input,'N',ret+6);
    p3=find(input,'E',ret+6);
    
    printf("\nN=");
    for(i=p1+2;i<p2-1;i++)
    printf("%c",input[i]);
    
    printf("\nE=");
    for(i=p2+2;i<p3-1;i++)
    printf("%c",input[i]);

}

运行结果：