STM32学习笔记:gps两种解码的方式
扫描二维码
随时随地手机看文章
做为现在的物联网行业,手持设备中,缺少不了的就是GPS定位功能。GPS模块和STM32的串口进行通信,将GPS的数据发送给M3的串口,由M3进行GPS协议的解码。解析出来后保存在响应的结构体中。在进行显示。
这里分别介绍2中解析协议的方法,第一种就是自己写解析协议函数,第二种便是采用别人写好的GPS解析协议库:NMEALIB库,将这个库移植到M3中,直接调用API函数,就可以解析出GPS信息,同样的也保存在一个结构体中。
下面分析一下这两种解析协议的算法,第一种,采用的是正点原子写的GPS解析算法(感谢原子哥)
//从buf里面得到第cx个逗号所在的位置//返回值:0~0XFE,代表逗号所在位置的偏移.//0XFF,代表不存在第cx个逗号u8NMEA_Comma_Pos(u8*buf,u8cx){u8*p=buf;while(cx){if(*buf=='*'||*buf<''||*buf>'z')return0XFF;//遇到'*'或者非法字符,则不存在第cx个逗号if(*buf==',')cx--;buf++;}returnbuf-p;//返回差值,}1234567891011121314
从GPS中得到的一串数据是这样的:GPRMC,083559.00,A,4717.11437,N,00833.91522,E,0.004,77.52,091202,,,A?57因此,我们可以调用这个函数,得到第几个逗号所距离第一个字符的位置,例如:NMEACommaPos(buf,2),我们的到的是,第二个逗号距离的位置,也就是17
//m^n函数//返回值:m^n次方.u32NMEA_Pow(u8m,u8n){u32result=1;while(n--)result*=m;returnresult;}12345678
这个就不用多说了,都看的懂,
//str转换为数字,以','或者'*'结束//buf:数字存储区//dx:小数点位数,返回给调用函数//返回值:转换后的数值intNMEA_Str2num(u8*buf,u8*dx){u8*p=buf;u32ires=0,fres=0;u8ilen=0,flen=0,i;u8mask=0;intres;while(1)//得到整数和小数的长度{if(*p=='-'){mask|=0X02;p++;}//是负数if(*p==','||(*p=='*'))break;//遇到结束了if(*p=='.'){mask|=0X01;p++;}//遇到小数点了elseif(*p>'9'||(*p<'0'))//有非法字符{ilen=0;flen=0;break;}if(mask&0X01)flen++;elseilen++;p++;}if(mask&0X02)buf++;//去掉负号for(i=0;i5)flen=5;//最多取5位小数*dx=flen;//小数点位数for(i=0;i 这个函数便是将两个逗号之间的字符串数字,变成整数,既将字符串“235”变成int(整型)数字,235
//分析GPGSV信息//gpsx:nmea信息结构体//buf:接收到的GPS数据缓冲区首地址voidNMEA_GPGSV_Analysis(nmea_msg*gpsx,u8*buf){u8*p,*p1,dx;u8len,i,j,slx=0;u8posx;p=buf;p1=(u8*)strstr((constchar*)p,"$GPGSV");//strstr判断$GPGSV是否是p数组的子串,是则返回$GPGSV中首先出现的地址,len=p1[7]-'0';//得到GPGSV的条数,p1[7]表示,后面的第一个字符。posx=NMEA_Comma_Pos(p1,3);//得到可见卫星总数,既将‘,’后面的字符里第一个字符的差值的到。if(posx!=0XFF)gpsx->svnum=NMEA_Str2num(p1+posx,&dx);//p1+posx得到可见卫星总数的指针,for(i=0;islmsg[slx].num=NMEA_Str2num(p1+posx,&dx);//得到卫星编号elsebreak;posx=NMEA_Comma_Pos(p1,5+j*4);if(posx!=0XFF)gpsx->slmsg[slx].eledeg=NMEA_Str2num(p1+posx,&dx);//得到卫星仰角elsebreak;posx=NMEA_Comma_Pos(p1,6+j*4);if(posx!=0XFF)gpsx->slmsg[slx].azideg=NMEA_Str2num(p1+posx,&dx);//得到卫星方位角elsebreak;posx=NMEA_Comma_Pos(p1,7+j*4);if(posx!=0XFF)gpsx->slmsg[slx].sn=NMEA_Str2num(p1+posx,&dx);//得到卫星信噪比elsebreak;slx++;}p=p1+1;//切换到下一个GPGSV信息}}1234567891011121314151617181920212223242526272829303132333435 这个便是解析GPGSV信息,GPGSV协议如下:
//分析GPGGA信息//gpsx:nmea信息结构体//buf:接收到的GPS数据缓冲区首地址voidNMEA_GPGGA_Analysis(nmea_msg*gpsx,u8*buf){u8*p1,dx;u8posx;p1=(u8*)strstr((constchar*)buf,"$GPGGA");posx=NMEA_Comma_Pos(p1,6);//得到GPS状态if(posx!=0XFF)gpsx->gpssta=NMEA_Str2num(p1+posx,&dx);posx=NMEA_Comma_Pos(p1,7);//得到用于定位的卫星数if(posx!=0XFF)gpsx->posslnum=NMEA_Str2num(p1+posx,&dx);posx=NMEA_Comma_Pos(p1,9);//得到海拔高度if(posx!=0XFF)gpsx->altitude=NMEA_Str2num(p1+posx,&dx);}123456789101112131415