做為現在的物聯(lián)網行業(yè),手持設備中,缺少不了的就是GPS定位功能。GPS模塊和STM32的串口進行通信,將GPS的數據發(fā)送給M3的串口,由M3進行GPS協(xié)議的解碼。解析出來后保存在響應的結構體中。在進行顯示。
這里分別介紹2中解析協(xié)議的方法,第一種就是自己寫解析協(xié)議函數,第二種便是采用別人寫好的GPS解析協(xié)議庫:NMEALIB庫,將這個庫移植到M3中,直接調用API函數,就可以解析出GPS信息,同樣的也保存在一個結構體中。
下面分析一下這兩種解析協(xié)議的算法,第一種,采用的是正點原子寫的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:數字存儲區(qū)//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數據緩沖區(qū)首地址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);//得到可見衛(wèi)星總數,既將‘,’后面的字符里第一個字符的差值的到。if(posx!=0XFF)gpsx->svnum=NMEA_Str2num(p1+posx,&dx);//p1+posx得到可見衛(wèi)星總數的指針,for(i=0;islmsg[slx].num=NMEA_Str2num(p1+posx,&dx);//得到衛(wèi)星編號elsebreak;posx=NMEA_Comma_Pos(p1,5+j*4);if(posx!=0XFF)gpsx->slmsg[slx].eledeg=NMEA_Str2num(p1+posx,&dx);//得到衛(wèi)星仰角elsebreak;posx=NMEA_Comma_Pos(p1,6+j*4);if(posx!=0XFF)gpsx->slmsg[slx].azideg=NMEA_Str2num(p1+posx,&dx);//得到衛(wèi)星方位角elsebreak;posx=NMEA_Comma_Pos(p1,7+j*4);if(posx!=0XFF)gpsx->slmsg[slx].sn=NMEA_Str2num(p1+posx,&dx);//得到衛(wèi)星信噪比elsebreak;slx++;}p=p1+1;//切換到下一個GPGSV信息}}1234567891011121314151617181920212223242526272829303132333435 這個便是解析GPGSV信息,GPGSV協(xié)議如下:
//分析GPGGA信息//gpsx:nmea信息結構體//buf:接收到的GPS數據緩沖區(qū)首地址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狀態(tài)if(posx!=0XFF)gpsx->gpssta=NMEA_Str2num(p1+posx,&dx);posx=NMEA_Comma_Pos(p1,7);//得到用于定位的衛(wèi)星數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