MATLAB解析GPS数据程序.docx
《MATLAB解析GPS数据程序.docx》由会员分享，可在线阅读，更多相关《MATLAB解析GPS数据程序.docx（22页珍藏版）》请在冰豆网上搜索。
MATLAB解析GPS数据程序
%注:
本程序可直接在MATＬAB 2０17a中运行
％该脚本文件用于学习GPS数据得读取,需要做其她用途请自行修改代码
％本脚本文件得前面几行代码就是要设置得一些参数
%默认使用3（需视情况修改）
％波特率设为ＧPS模块默认得３8400
%下面为程序源码
clear
num_ｅxecuｔｅ＝100;％执行次数
ｎum＿SingleＲｅaｄ=１５0； %单次从串口读取得字节数（最好设置足够大（最低大概设为8０），保证单次读取得数据包含一条完整得ＧＰS数据）
Timedeｌay= 0、２；％ 用于延时读取串口数据
BaｕdRate = 3840０；%读取数据得波特率
Teｒｍinatｏｒ='CＲ';
nuｍ_ＭaxTry =５；%打开串口得最多尝试次数
ByｔｅsAvａｉlableFcnCounｔ=１０00；
％%设置参数
% deletｅ（inｓtrfｉnｄaｌl）;％串口打开失败时使用此句
％delete（ｓ）；ｃlｅａrs %串口打开失败时使用此句
ｓeriａl3＝ seriaｌ（'3'）;
%串口设置
ｓeriａl3、ＢyteｓAvａiｌaｂｌeFcnMode=’ｂyｔe';
%seriａl3、InputＢｕfｆerSiｚe＝38４0０;%输出波特率
seｒial３、BａuｄRａte =BaudRate; %读入波特率
%ｓeriａl3、OutpuｔＢuffeｒSize= 1024;
serｉal３、BytesAｖaｉlａblｅFcnCounｔ =BｙｔesAvailaｂｌeFcｎCoｕｎｔ；
ｓeｒiａｌ3、ＲeaｄAｓynｃModｅ='contｉnuouｓ’；
sｅrial３、Terminatoｒ=Termiｎatｏｒ;
%% 打开串口
cｏunt_oｐeｎtimｅs = 1;
whｉleｃontaiｎs（seｒial3、ｓtatus,’cｌosｅd'） 〉0&＆ ｃount_oｐeｎtimes 〈num_ＭaxTry
fopen（sｅｒiａl３）;%打开串口
cｏuｎt＿oｐenｔiｍes=count_ｏｐeｎtimes+1;
eｎd
ｉfcontainｓ（sｅｒial３、status,’oｐen'） < 1
disp（’ｏpenfailed!
＇）;
retｕrn
ｅnd
％％读取并处理数据
%初始化
GＰS＿Data＝GPS_Ｉｎit（）;
whilｅ（num_eｘecｕｔe 〉0）
ＧPS_DataSｔrｓ=ｆreａd（serial３,nｕｍ_SiｎｇleRead,'chａｒ’）； %一次读出1０个字符
GＰS＿ＤａtaStｒs=ｒｅshape（GPＳ_DatａStrｓ，１,[］）；
GPS_DatａStrs＝ｓplit_str２ｓtrs（ＧPS＿DatａStrs）;
GPS_Dａtａ＿tmp =get_GPＳ_spｅｃｉficData（GPS_DaｔaＳｔｒs）；
GPS_Data=Updaｔａ_GPＵ＿Ｄaｔa（GＰS_Ｄata,GPS_Ｄata_tmp）;
sｈow_GPＳ_Dａta（GPS＿Data）；
pａｕse（Timedelay）;％延时
ｎｕm＿ｅxeｃｕtｅ = num_exｅｃute—１;
end
%fｐriｎｔｆ（ｓ,'abcｄ'）； ％给串口得发送数据
%fｓcanf（s）; %从串口得接收缓存读数据
％％关闭串口并删除相关数据
fｃlosｅ（ｓeｒｉａl3）; ％关闭串口
deｌete（seriaｌ3）;
clearseｒiaｌ3
%%
％将字符串根据'\r\ｎ'划分成多个子字符串，同时去掉首尾无用得残余字符串
ｆuｎcｔiｏnoｕt＿strs = spliｔ_str2ｓtｒs（StrData）
ifｃontaiｎs（cｌasｓ（ＳtrData）,’char'）
uｉnｔ8（StrData）；
end
rｅcord=gｅt_pｏs_ｅｎterfｌaｇ（ＳtrＤatａ）;
ifStrDａｔa（１）==uint8（'$'）%开头为＇$’得情况
flag_sｔart ＝1;
ｅlsｅ
ifｓｉze（recoｒｄ,2）＞０
flag_start=recoｒd
（1）+２;
eｌse
ｏut_sｔrs=ｃell（0,0）；
ｒｅｔｕrn
ｅnｄ
end
ifＳtrData（end）＝=1３
flag_end= lengtｈ（StrＤata）—1；
else
ifsizｅ（rｅcoｒｄ,2）〉0
flaｇ_end=ｒecord（eｎd）-１;
ｅnd
end
if fｌaｇ_ｓtart〉=fｌａg_ｅnｄ
ｏut＿ｓtrs=cｅll（0,0）;
ｒeturｎ
enｄ
StrＤaｔa＝ StｒDaｔa（flag_ｓtarｔ:
flag_end）;％截取有效数据,方便下面划分子字符串
record=geｔ_pos_enｔerflag（ＳtrDａta）;
num_stｒs＝sｉzｅ（record，2）+1；
oｕt_strs＝ cell（num_strs,1）;
ｉfｎuｍ＿strs〉1
out_strs{１，１｝=char（StrData（1：
recorｄ
（1）—1））;
iｆnuｍ_strｓ ＝=2
out＿strs{nｕｍ_ｓtrs,１｝=ｃｈar（ＳtrData（recoｒd
（1）+２:
eｎd））;
else
fｏr ｉ=2：
nｕm_strs－１
ｏut_strｓ｛i,１｝＝char（ＳtrＤａta（record（i—1）+2:
rｅcｏrd（i）-1））;
ｅｎd
ｏｕt＿strs｛ｎuｍ_strs，1}＝ chaｒ（ＳｔrDａtａ（recｏrd（i）+2:
ｅnd））;
end
eｌse
ouｔ_strｓ｛1，1} =char（StrDaｔａ）;
eｎd
％得到字符串中’\r\n’在字符串中得位置（实际为'＼r’得位置）
functｉonrecｏrｄ=get＿poｓ_enterｆlag（dａta）
rｅcord=[］；%记录回车符号位置
ｆｏrii= 1：
ｌength（dａta）—1
ｉfdatａ（ii）=＝１３
ｉf ｄata（iｉ+１） == 10
reｃｏrd=［record，ｉｉ］;
ｉi=iｉ+1;
eｎd
eｎｄ
end
ｅnｄ
enｄ
%得到具体GPS结构体数据
fｕnctionGPＳ_Data_tmp=get_GＰＳ_specｉｆｉcDatａ（StrsData）
GPＳ_Datａ_tｍp = [];
num_sｔr=size（ＳｔrsDａta，１）;
fｏr i＝１：
num＿str
str_tab=StｒsＤata{i，1};
ifcontainｓ（str_ｔａb,＇GGA’）〉０
ＧPS_Daｔa_tmｐ＝ GＮＧGＡ（ｓtr_tab）；
ｅｌｓeiｆcｏntains（str＿ｔａｂ，’GSＡ'）>0
GPＳ_Dａtａ＿tmp=GＮＧSＡ（ｓtr＿tab）；
ｅlsｅifcontａｉns（ｓtｒ＿tａb,'GSV’）>0
ＧPS_Daｔa_tmp =GNGSV（str_tab）;
elseifcｏntains（ｓtr＿ｔab,’RＭC’）〉 0
GＰS_Ｄａta＿tmp =GNRMＣ（ｓtｒ_tａb）;
elseifｃontaｉnｓ（str_tab,’VTＧ’）〉 ０
GPS_Datａ_tｍp=GNＶTG（ｓｔｒ_ｔaｂ）;
elseｉf contａｉｎs（ｓtr＿ｔab,’GＬL＇）>0
GPS_Data_tｍｐ =ＧNGLＬ（ｓtr_tab）;
end
eｎd
enｄ
% GＰS字符串解析
ｆuncｔｉoｎGPS_Daｔa_ｔｍp＝ ＧＮGGＡ（stｒ_tab）
iｎｄeｘ=strｆind（ｓtr_tab,’,'）;
couｎｔ =1；
Time = ｓtr_ｔaｂ（iｎｄex（cｏｕnt）+1:
indeｘ（cｏｕnt+1）－1）;cｏunｔ=count+1；
Latitｕde =ｓtr_tａb（indｅx（count）＋1:
inｄex（cｏunt+1）—1）;count=cｏuｎt+1;
GPＳ_Datａ_tｍｐ、ＬａtiｔuｄeDiｒ= stｒ＿tab（ｉnｄeｘ（couｎt）＋1：
ｉndex（count+１）—1）;cｏｕnｔ=count＋１;
Ｌongitudｅ = ｓｔr_tａb（ｉndex（count）＋１:
indｅx（count+1）—１）;ｃouｎt=count＋1;
GPS_Ｄata_tmp、LonｇiｔｕdeＤir=str_tab（index（ｃｏunt）+1:
index（cｏunt+1）-1）;counｔ＝count＋1；
GPＳ_Ｄatａ_tmp、GPＳSｔatｅ =stｒ＿tab（ｉｎｄeｘ（count）＋1:
inｄex（count+1）-1）；coｕnt＝cｏunt+1;
ＧPS＿Dａta_tｍp、ＳatellｉteNum= str_ｔab（ｉndｅx（cｏｕnt）+1:
iｎdeｘ（counｔ+1）—１）；ｃouｎt=ｃoｕnt＋1；
GPS_Dａta＿tmｐ、HＤOP =stｒ_ｔaｂ（inｄex（ｃoｕｎｔ）+１：
index（ｃounｔ+１）－１）;count=couｎｔ＋1;
GPS_Data_ｔmp、altitude =str_ｔab（inｄex（counｔ）+1:
ｉｎdeｘ（count+１）-1）；cｏｕnt=ｃoｕnt+1;
％otｈer =stｒ_tab（indeｘ（couｎt）+1：
end）；
%进一步处理
GPS_Data_tmp、Time、hour=Time（1：
2）;
ＧPS_Daｔa_ｔmp、Time、miｎ =Time（3:
4）；
GPS_Data_tｍp、Ｔime、sｅc＝ Timｅ（5：
６）;
GＰS＿Data_tmp、Time、milｌisec=Ｔｉmｅ（8：
1０）；
ＧPS_Ｄata_tmp、Latitude、dｅｇree＝Ｌaｔiｔude（1:
2）; %纬度
ＧPS_Daｔa_tmｐ、Laｔｉtude、min=Ｌatitｕde（3:
4）;
tmp=sｔr2doubｌe（Latｉtude（6:
9））;
tmp= tmp＊6／1000;%ｔmp =ｔｍｐ/1000０*60；
GPS_Dａta＿tmｐ、Latiｔude、ｓec=num2ｓtｒ（fｌooｒ（tmp））;
GＰS＿Data_tmp、Ｌaｔｉtude、miｌlisec＝ nｕm2ｓtｒ（（ｔmp-floｏr（tｍｐ））*１000０）;
GPS_Ｄaｔa_tmｐ、Loｎgitude、degｒeｅ=Longitudｅ（1:
3）;%经度
GPＳ＿Datａ_tmｐ、Ｌｏnｇｉtｕｄe、min＝Lｏｎgｉｔude（4:
5）；
ｔｍｐ ＝str2doｕblｅ（Lｏｎgitude（7:
10））；
tmp= tmp＊6/1000；%tmｐ =tmp／1００00*60;
GＰS＿Dａｔa_tmp、Longitude、sec=nｕm2ｓtr（ｆloｏr（ｔmp））;
ＧPS_Data_tｍp、Ｌongitude、ｍiｌlisec＝ｎｕm２ｓtr（（tmｐ—ｆlｏor（tmp））＊10０0０）；
％UＴC时间转换为北京时间
hoｕｒ=GPS_Dａtａ_ｔmp、Tｉmｅ、hｏｕr；
ｉfstr２ｎum（houｒ）+8>＝ 24
GPS＿Ｄata_ｔmp、Ｔime、hoｕr = num2ｓｔr（stｒ２nｕm（hｏuｒ）+８—2４）;
else
GPS_Datａ_tmｐ、Tiｍe、hｏｕr＝num２str（stｒ2num（hour）+8）；
ｅnd
end
fｕnctioｎ GPS_Ｄaｔa_tmp=GNGSA（sｔr_tab）
inｄex=stｒfind（sｔr_ｔab,’,＇）；
ｃｏunt= 1;
ＧPS＿Data_ｔmp、ＬocaｔｉonMoｄe=ｓtr_tab（inｄex（count）+1:
index（coｕｎt＋1）－1）;cｏunt=couｎt+1；
ＧPS＿Ｄatａ_ｔmp、CｕrＳtate =sｔｒ＿tab（index（coｕｎt）+1:
inｄｅｘ（counｔ＋1）—1）;count=count+1;
GPＳ_Datａ＿tmp、PRＮ =str＿tａb（inｄeｘ（counｔ）+１:
inｄex（count+1）-1）；count＝coｕnt＋1；
GPS＿Data＿tｍp、PＤOP ＝ str＿tab（inｄｅx（ｃount）+1:
indｅx（cｏunt+１）—１）；cｏunt=counｔ+１;
GPS_Dａta＿tmp、HＤOP = stｒ_tab（indｅx（ｃounｔ）+1:
index（couｎｔ+1）-1）；count=ｃount+１;
GPS_Daｔａ＿tmｐ、VDＯＰ =ｓtｒ_ｔａｂ（inｄex（ｃouｎt）＋１:
iｎｄｅx（ｃｏunt+1）-1）；ｃoｕnt=ｃｏunt+1;
％ other = str＿ｔab（iｎdex（coｕnt）+1：
end）;
end
ｆunctioｎ GPS_Daｔa_ｔmp＝ GNＧＳV（ｓｔｒ_tａｂ）
%此语句为与卫星有关得信息（包括卫星方位,卫星编号）
%暂时用不着,不处理
GPS_Datａ_ｔmp =[];
eｎｄ
fｕｎctｉｏnGPS_Ｄata＿tmp= GＮＲMＣ（str_tａb）
iｎｄex=strfind（ｓｔｒ＿tab，',’）;
ｃount＝１;
Tｉme = ｓｔr_tab（inｄex（ｃount）+１:
indeｘ（cｏunt+1）—1）;coｕnt=ｃouｎｔ+1;
GＰS_Data＿tmｐ、ＬocaｔiｏnSｔaｔe＝ str＿ｔａb（iｎｄｅx（ｃｏｕnt）＋1:
index（ｃouｎt＋１）—1）；coｕnt=ｃount+1;
Laｔiｔudｅ =sｔr_tａｂ（indeｘ（cｏｕnt）+1:
ｉndex（cｏｕnt+1）-１）；ｃｏuｎt=coｕnｔ+１;
ＧPS_Data_tmp、LａtitｕdeＤｉr＝stｒ_ｔab（iｎｄex（ｃｏｕｎt）+1：
indｅx（cｏunｔ+1）-1）;count=couｎｔ+1;
Lｏngｉtuｄe =str_ｔab（ｉnｄｅx（couｎt）+１:
indｅx（count+１）-１）；count＝counｔ+1;
GPS＿Data_tｍp、LongｉｔｕdｅDｉr ＝str_tａb（indｅx（coｕnt）+1：
indeｘ（couｎt+1）—1）；count=ｃoｕnt+1；
ＧPS_Datａ＿tmｐ、speed= str_tab（inｄｅx（count）＋1:
index（cｏunt+１）—１）;count=count+1;
GPS_Data＿tmｐ、TrueＤir ＝stｒ＿tａb（index（coｕｎｔ）+１:
ｉndｅx（count＋1）-1）;ｃount=ｃｏunt+1；
Ｄate ＝ｓtr_tab（index（count）＋１：
index（cｏunｔ＋1）－1）；count=coｕnt+1;
GPS＿Data＿tmp、MagneticAnｇｌｅ=stｒ_taｂ（ｉndex（ｃoｕnt）＋１:
inｄeｘ（coｕnt＋1）—１）；counｔ=coｕnt＋1;
ＧPＳ＿Ｄata_ｔmp、MａgｎeticDir= str_ｔab（ｉndex（cｏuｎt）+1：
iｎdeｘ（coｕnt+１）－１）；ｃount＝ｃoｕnt＋1；
%oｔheｒ = ｓｔｒ＿ｔab（index（cｏunt）+1：
end）；
％ 进一步处理
GPS＿Ｄａｔａ_tｍｐ、Ｔｉｍｅ、ｈｏur= Tｉme（1：
2）；
GPS＿Data_tmp、Time、ｍin=Tiｍe（3:
4）;
GPS_Ｄata＿tｍp、Timｅ、sec=Tｉme（5:
6）；
ＧＰS_Ｄａta_ｔmp、Time、milｌisｅc=Tｉmｅ（8:
1０）;
GPS_Data_tmp、Ｌatitude、degｒee=Latituｄe（1:
2）; % 纬度
GPS_Data_ｔmｐ、Latｉｔude、ｍｉn= Ｌatiｔude（3:
４）;
tmp=str2double（Latiｔude（6:
9））；
ｔmp=tmp*６/1000；％ tｍp=tmp/10000*６０；
GPＳ_Ｄata_ｔmp、Lａtiｔｕde、sec =nｕｍ２str（fｌoｏr（tmｐ））;
GPＳ_Data_tmｐ、Latituｄe、millisec=num２str（（tmp—fｌoor（ｔmp））*10000）;
GPS_Ｄata_tmp、Longitude、degreｅ=Loｎgiｔude（1:
3）;% 经度
GPＳ_Data_ｔmp、Lｏngiｔude、min =Loｎgitｕde（４：
5）；
tmｐ=sｔr2double（Lｏngitude（7:
１0））;
tmp＝tmｐ*6／1０00; %tmｐ=ｔmp/100０0＊60;
ＧPS_Ｄata_tmｐ、Lonｇiｔude、ｓｅc＝ ｎum２sｔｒ（fｌoor（tｍｐ））；
ＧPS_Ｄaｔa_tmｐ、Longituｄe、milｌｉｓec=num2sｔr（（tmｐ—ｆｌooｒ（tmｐ））*100００）；
GPS_Ｄata_tmp、DＡTE、day ＝Date（1：
２）;
ＧPS_Data＿tmp、DＡTE、mｏnth=Ｄatｅ（3：
４）;
ＧＰS_Dａｔａ_tmｐ、ＤATE、year=Ｄate（５：
6）;
%ＵTC时间转换为北京时间
ｈour =GＰS_Daｔa＿tｍｐ、Time、houｒ;
iｆstr2num（hoｕr）＋8＞=2４
GPS_Ｄata_ｔｍp、Tiｍe、hｏur = ｎum2str（str２nuｍ（ｈｏｕr）＋8—24）;
ｅlse
GPS_Data_tmｐ、Time、hoｕr= nuｍ２stｒ（str2num（houｒ）+８）;
enｄ
ｅnｄ
functionGPＳ_Ｄata_tmｐ=GＮVTG（ｓｔｒ_ｔab）
index=sｔｒfind（str＿ｔaｂ，'，＇）;
ｃount=1;
ＧPS_Ｄata_tmp、ＴｒuｅDir ＝str＿tab（iｎdｅx（cｏunt）+1:
iｎdeｘ（coｕnt+1）—1）;count=couｎt+1；
GPS_Datａ＿tmp、ＲefeｒenceＴrueDｉr =str_tab（iｎｄex（count）+1：
inｄeｘ（coｕnt+1）-1）；ｃount=ｃouｎt+1;
GＰS_Data＿ｔmp、RelａtｉveDir =ｓｔr＿tab（ｉndeｘ（cｏunt）＋1:
iｎｄeｘ（couｎt＋1）－1）；cｏunt=ｃｏuｎt＋1；
GPＳ＿Data＿tmｐ、RefｅｒenceRelａtiveDir= stｒ＿tａb（indｅx（counｔ）+1:
indｅx（coｕｎt＋1）—1）；cｏunt=couｎt+1;
GPS_Ｄaｔa_tmp、sｔep =ｓｔr_ｔab（index（count）+1：
ｉndex（coｕｎｔ＋1）—1）;couｎｔ=ｃouｎt＋1;
GPＳ＿Data_ｔmp、sｔｅpfｌaｇ ＝ｓｔr_ｔab（iｎdｅｘ（counｔ）+１:
index（counｔ＋1）-1）;coｕｎt=couｎｔ+１;
GPS_Ｄaｔａ_tｍp、ｖelocity = ｓtr_tab（index（count）+1:
index（count+1）-1）；cｏunｔ＝ｃount+1;
%ｏｔｈer =str_tab（indeｘ（counｔ）+1:
end）;
end
functiｏnGPS_Data_tmp=GNＧLＬ（str_ｔaｂ）
ｉｎdex=strfind（sｔｒ_tab，'，’）;
cｏｕnt =1;
Ｌatitudｅ = str_ｔab（index（cｏunt）＋1：
iｎdex（couｎt+1）－1）；cｏｕnt＝count+1;
GＰS_Data_tmp、LatｉｔudeDir =ｓtr＿ｔab（ｉndex（counｔ）+1:
inｄｅｘ（count+１）-１）;cｏuｎt=coｕnt+1；
Ｌongiｔude =ｓtr_tａｂ（index（ｃｏunt）+１：
index（ｃｏunt+1）—1）;ｃoｕnt=count＋1；
ＧPS_Data_tmp、LongitｕｄｅＤir＝ｓtr_ｔａb（iｎｄex（count）＋1:
iｎdex（ｃoｕnt+１）-1）；ｃｏｕnt=count＋1;
Date =str_tab（index（couｎt）＋1：
ｉndex（ｃｏｕｎt+1）-1）;ｃｏunt＝coｕnｔ+1;
GＰS_Dａｔa＿tmp、LocａtioｎStａte=str_tａb（indeｘ（count）＋1:
indｅx（ｃount+1）-１
升级会员 