STM32學(xué)習(xí)筆記:gps兩種解碼的方式
做為現(xiàn)在的物聯(lián)網(wǎng)行業(yè),手持設(shè)備中,缺少不了的就是GPS定位功能。GPS模塊和STM32的串口進(jìn)行通信,將GPS的數(shù)據(jù)發(fā)送給M3的串口,由M3進(jìn)行GPS協(xié)議的解碼。解析出來后保存在響應(yīng)的結(jié)構(gòu)體中。在進(jìn)行顯示。
這里分別介紹2中解析協(xié)議的方法,第一種就是自己寫解析協(xié)議函數(shù),第二種便是采用別人寫好的GPS解析協(xié)議庫(kù):NMEALIB庫(kù),將這個(gè)庫(kù)移植到M3中,直接調(diào)用API函數(shù),就可以解析出GPS信息,同樣的也保存在一個(gè)結(jié)構(gòu)體中。
下面分析一下這兩種解析協(xié)議的算法,第一種,采用的是正點(diǎn)原子寫的GPS解析算法(感謝原子哥)
//從buf里面得到第cx個(gè)逗號(hào)所在的位置//返回值:0~0XFE,代表逗號(hào)所在位置的偏移.//0XFF,代表不存在第cx個(gè)逗號(hào)u8NMEA_Comma_Pos(u8*buf,u8cx){u8*p=buf;while(cx){if(*buf=='*'||*buf<''||*buf>'z')return0XFF;//遇到'*'或者非法字符,則不存在第cx個(gè)逗號(hào)if(*buf==',')cx--;buf++;}returnbuf-p;//返回差值,}1234567891011121314
從GPS中得到的一串?dāng)?shù)據(jù)是這樣的:GPRMC,083559.00,A,4717.11437,N,00833.91522,E,0.004,77.52,091202,,,A?57因此,我們可以調(diào)用這個(gè)函數(shù),得到第幾個(gè)逗號(hào)所距離第一個(gè)字符的位置,例如:NMEACommaPos(buf,2),我們的到的是,第二個(gè)逗號(hào)距離的位置,也就是17
//m^n函數(shù)//返回值:m^n次方.u32NMEA_Pow(u8m,u8n){u32result=1;while(n--)result*=m;returnresult;}12345678
這個(gè)就不用多說了,都看的懂,
//str轉(zhuǎn)換為數(shù)字,以','或者'*'結(jié)束//buf:數(shù)字存儲(chǔ)區(qū)//dx:小數(shù)點(diǎn)位數(shù),返回給調(diào)用函數(shù)//返回值:轉(zhuǎn)換后的數(shù)值intNMEA_Str2num(u8*buf,u8*dx){u8*p=buf;u32ires=0,fres=0;u8ilen=0,flen=0,i;u8mask=0;intres;while(1)//得到整數(shù)和小數(shù)的長(zhǎng)度{if(*p=='-'){mask|=0X02;p++;}//是負(fù)數(shù)if(*p==','||(*p=='*'))break;//遇到結(jié)束了if(*p=='.'){mask|=0X01;p++;}//遇到小數(shù)點(diǎn)了elseif(*p>'9'||(*p<'0'))//有非法字符{ilen=0;flen=0;break;}if(mask&0X01)flen++;elseilen++;p++;}if(mask&0X02)buf++;//去掉負(fù)號(hào)for(i=0;i5)flen=5;//最多取5位小數(shù)*dx=flen;//小數(shù)點(diǎn)位數(shù)for(i=0;i 這個(gè)函數(shù)便是將兩個(gè)逗號(hào)之間的字符串?dāng)?shù)字,變成整數(shù),既將字符串“235”變成int(整型)數(shù)字,235
//分析GPGSV信息//gpsx:nmea信息結(jié)構(gòu)體//buf:接收到的GPS數(shù)據(jù)緩沖區(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數(shù)組的子串,是則返回$GPGSV中首先出現(xiàn)的地址,len=p1[7]-'0';//得到GPGSV的條數(shù),p1[7]表示,后面的第一個(gè)字符。posx=NMEA_Comma_Pos(p1,3);//得到可見衛(wèi)星總數(shù),既將‘,’后面的字符里第一個(gè)字符的差值的到。if(posx!=0XFF)gpsx->svnum=NMEA_Str2num(p1+posx,&dx);//p1+posx得到可見衛(wèi)星總數(shù)的指針,for(i=0;islmsg[slx].num=NMEA_Str2num(p1+posx,&dx);//得到衛(wèi)星編號(hào)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;//切換到下一個(gè)GPGSV信息}}1234567891011121314151617181920212223242526272829303132333435 這個(gè)便是解析GPGSV信息,GPGSV協(xié)議如下:
//分析GPGGA信息//gpsx:nmea信息結(jié)構(gòu)體//buf:接收到的GPS數(shù)據(jù)緩沖區(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)星數(shù)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