$GPVTG,359.95,T,,M,15.15,N,28.0,K,A*04
Track Made Good and Ground Speed(VTG)地面速度信息
$GPVTG,<1>,T,<2>,M,<3>,N,<4>,K,<5>*hh<CR><LF>
<1> 以真北为参考基准的地面航向(000~359度,前面的0也将被传输)
<2> 以磁北为参考基准的地面航向(000~359度,前面的0也将被传输)
<3> 地面速率(000.0~999.9节,前面的0也将被传输)
<4> 地面速率(0000.0~1851.8公里/小时,前面的0也将被传输)
<5> 模式指示(仅NMEA0183 3.00版本输出,A=自主定位,D=差分,E=估算,N=数据无效)
/VTG Struct/
typedef struct
{
float cog_t;
char t[5];
float cog_m;
char m[5];
float speed_n;
char n[5];
float speed_k;
char k[5];
}NEMA_VTG_t;
/*
*功能:解析GLL语句
*输入:GLL语句
*输出:(NEMA_GLL_t)解析结果
*/
NEMA_VTG_t nema_vtg_parse(char *nema_vtg_str)
{
NEMA_VTG_t vtg;
char *q = strstr(nema_vtg_str,“VTG”);
sscanf(q,"%*[^,],%f,%[^,],%f,%[^,],%f,%[^,],%f,%[^*]",
&vtg.cog_t,vtg.t,&vtg.cog_m,vtg.m,&vtg.speed_n,vtg.n,&vtg.speed_k,vtg.k);
return vtg;
}
/*****************************************************************************/
/*
*示例
*/
int main(int argc, char **argv)
{
char *nema_vtg = "GPVTG,89.68,T,89.68,M,0.00,N,0.0,K*5F";
printf("nema_vtg = %s\r\n\r\n",nema_vtg);
NEMA_VTG_t vtg = nema_vtg_parse(nema_vtg);
printf("cog_t = %f\r\n",vtg.cog_t);
printf("t = %s\r\n",vtg.t);
printf("cog_m = %f\r\n",vtg.cog_m);
printf("m = %s\r\n",vtg.m);
printf("speed_n = %f\r\n",vtg.speed_n);
printf("n = %s\r\n",vtg.n);
printf("speed_k = %f\r\n",vtg.speed_k);
printf("k = %s\r\n",vtg.k);
}
总结:针对不同导航器可能出现不兼容的问题,首先可以总结其语句后缀是否相同,然后设计出统一的解析代码,分别解析不同导航系统的VTG语句即可。
---------------------
作者:瑞奇Ricky
来源:CSDN
原文:https://blog.csdn.net/guowuzhou/article/details/119614619
版权声明:本文为作者原创文章,转载请附上博文链接!
内容解析By:CSDN,CNBLOG博客文章一键转载插件