设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › STM32单片机AIR551G GPS定位程序
返回列表 发新帖
查看: 1380|回复: 0
打印 上一主题 下一主题
收起左侧

STM32单片机AIR551G GPS定位程序

[复制链接]
跳转到指定楼层
楼主
ID:972352 发表于 2022-12-16 11:39 | 只看该作者 |只看大图 回帖奖励 |倒序浏览 |阅读模式
合轴551G模块，移植了正点原子的开发板程序

STM32单片机源程序如下:
  1. #include "gps.h"
  2. #include "led.h"
  3. #include "SysTick.h"                                                           
  4. #include "usart3.h"                                                                    
  5. #include "stdio.h"         
  6. #include "stdarg.h"         
  7. #include "string.h"         
  8. #include "math.h"
  9.          

  11.                                                   
  12. u8 NMEA_Comma_Pos(u8 *buf,u8 cx)
  13. {                             
  14.         u8 *p=buf;
  15.         while(cx)
  16.         {                 
  17.                 if(*buf=='*'||*buf<' '||*buf>'z')return 0XFF;//遇到'*'或者非法字符,则不存在第cx个逗号
  18.                 if(*buf==',')cx--;
  19.                 buf++;
  20.         }
  21.         return buf-p;         
  22. }
  23. //m^n函数
  24. //返回值:m^n次方.
  25. u32 NMEA_Pow(u8 m,u8 n)
  26. {
  27.         u32 result=1;         
  28.         while(n--)result*=m;   
  29.         return result;
  30. }
  31. //str转换为数字,以','或者'*'结束
  32. //buf:数字存储区
  33. //dx:小数点位数,返回给调用函数
  34. //返回值:转换后的数值
  35. int NMEA_Str2num(u8 *buf,u8*dx)
  36. {
  37.         u8 *p=buf;
  38.         u32 ires=0,fres=0;
  39.         u8 ilen=0,flen=0,i;
  40.         u8 mask=0;
  41.         int res;
  42.         while(1) //得到整数和小数的长度
  43.         {
  44.                 if(*p=='-'){mask|=0X02;p++;}//是负数
  45.                 if(*p==','||(*p=='*'))break;//遇到结束了
  46.                 if(*p=='.'){mask|=0X01;p++;}//遇到小数点了
  47.                 else if(*p>'9'||(*p<'0'))        //有非法字符
  48.                 {        
  49.                         ilen=0;
  50.                         flen=0;
  51.                         break;
  52.                 }        
  53.                 if(mask&0X01)flen++;
  54.                 else ilen++;
  55.                 p++;
  56.         }
  57.         if(mask&0X02)buf++;        //去掉负号
  58.         for(i=0;i<ilen;i++)        //得到整数部分数据
  59.         {  
  60.                 ires+=NMEA_Pow(10,ilen-1-i)*(buf[i]-'0');
  61.         }
  62.         if(flen>5)flen=5;        //最多取5位小数
  63.         *dx=flen;                         //小数点位数
  64.         for(i=0;i<flen;i++)        //得到小数部分数据
  65.         {  
  66.                 fres+=NMEA_Pow(10,flen-1-i)*(buf[ilen+1+i]-'0');
  67.         }
  68.         res=ires*NMEA_Pow(10,flen)+fres;
  69.         if(mask&0X02)res=-res;                  
  70.         return res;
  71. }                                                                  
  72. //分析GPGSV信息    可见卫星信息
  73. //gpsx:nmea信息结构体
  74. //buf:接收到的GPS数据缓冲区首地址
  75. void NMEA_GPGSV_Analysis(nmea_msg *gpsx,u8 *buf)
  76. {
  77.         u8 *p,*p1,dx;
  78.         u8 len,i,j,slx=0;
  79.         u8 posx;            
  80.         p=buf;
  81.         p1=(u8*)strstr((const char *)p,"$GPGSV");
  82.         len=p1[7]-'0';                                                                //得到GPGSV的条数
  83.         posx=NMEA_Comma_Pos(p1,3);                                         //得到可见卫星总数
  84.         if(posx!=0XFF)gpsx->svnum=NMEA_Str2num(p1+posx,&dx);
  85.         for(i=0;i<len;i++)
  86.         {         
  87.                 p1=(u8*)strstr((const char *)p,"$GPGSV");  
  88.                 for(j=0;j<4;j++)
  89.                 {         
  90.                         posx=NMEA_Comma_Pos(p1,4+j*4);
  91.                         if(posx!=0XFF)gpsx->slmsg[slx].num=NMEA_Str2num(p1+posx,&dx);        //得到卫星编号
  92.                         else break;
  93.                         posx=NMEA_Comma_Pos(p1,5+j*4);
  94.                         if(posx!=0XFF)gpsx->slmsg[slx].eledeg=NMEA_Str2num(p1+posx,&dx);//得到卫星仰角
  95.                         else break;
  96.                         posx=NMEA_Comma_Pos(p1,6+j*4);
  97.                         if(posx!=0XFF)gpsx->slmsg[slx].azideg=NMEA_Str2num(p1+posx,&dx);//得到卫星方位角
  98.                         else break;
  99.                         posx=NMEA_Comma_Pos(p1,7+j*4);
  100.                         if(posx!=0XFF)gpsx->slmsg[slx].sn=NMEA_Str2num(p1+posx,&dx);        //得到卫星信噪比
  101.                         else break;
  102.                         slx++;           
  103.                 }   
  104.                  p=p1+1;//切换到下一个GPGSV信息
  105.         }   
  106. }
  107. //分析BDGSV信息
  108. //gpsx:nmea信息结构体
  109. //buf:接收到的GPS数据缓冲区首地址
  110. void NMEA_BDGSV_Analysis(nmea_msg *gpsx,u8 *buf)
  111. {
  112.         u8 *p,*p1,dx;
  113.         u8 len,i,j,slx=0;
  114.         u8 posx;            
  115.         p=buf;
  116.         p1=(u8*)strstr((const char *)p,"$BDGSV");
  117.         len=p1[7]-'0';                                                                //得到BDGSV的条数
  118.         posx=NMEA_Comma_Pos(p1,3);                                         //得到可见北斗卫星总数
  119.         if(posx!=0XFF)gpsx->beidou_svnum=NMEA_Str2num(p1+posx,&dx);
  120.         for(i=0;i<len;i++)
  121.         {         
  122.                 p1=(u8*)strstr((const char *)p,"$BDGSV");  
  123.                 for(j=0;j<4;j++)
  124.                 {         
  125.                         posx=NMEA_Comma_Pos(p1,4+j*4);
  126.                         if(posx!=0XFF)gpsx->beidou_slmsg[slx].beidou_num=NMEA_Str2num(p1+posx,&dx);        //得到卫星编号
  127.                         else break;
  128.                         posx=NMEA_Comma_Pos(p1,5+j*4);
  129.                         if(posx!=0XFF)gpsx->beidou_slmsg[slx].beidou_eledeg=NMEA_Str2num(p1+posx,&dx);//得到卫星仰角
  130.                         else break;
  131.                         posx=NMEA_Comma_Pos(p1,6+j*4);
  132.                         if(posx!=0XFF)gpsx->beidou_slmsg[slx].beidou_azideg=NMEA_Str2num(p1+posx,&dx);//得到卫星方位角
  133.                         else break;
  134.                         posx=NMEA_Comma_Pos(p1,7+j*4);
  135.                         if(posx!=0XFF)gpsx->beidou_slmsg[slx].beidou_sn=NMEA_Str2num(p1+posx,&dx);        //得到卫星信噪比
  136.                         else break;
  137.                         slx++;           
  138.                 }   
  139.                  p=p1+1;//切换到下一个BDGSV信息
  140.         }   
  141. }
  142. //分析GNGGA信息
  143. //gpsx:nmea信息结构体
  144. //buf:接收到的GPS数据缓冲区首地址
  145. void NMEA_GNGGA_Analysis(nmea_msg *gpsx,u8 *buf)
  146. {
  147.         u8 *p1,dx;                        
  148.         u8 posx;   
  149.         p1=(u8*)strstr((const char *)buf,"$GNGGA");
  150.         posx=NMEA_Comma_Pos(p1,6);                                                                //得到GPS状态
  151.         if(posx!=0XFF)gpsx->gpssta=NMEA_Str2num(p1+posx,&dx);        
  152.         posx=NMEA_Comma_Pos(p1,7);                                                                //得到用于定位的卫星数
  153.         if(posx!=0XFF)gpsx->posslnum=NMEA_Str2num(p1+posx,&dx);
  154.         
  155.         posx=NMEA_Comma_Pos(p1,8);                                                                //水平位置精度
  156.         if(posx!=0XFF)gpsx->hdop=NMEA_Str2num(p1+posx,&dx);
  157.         
  158.         posx=NMEA_Comma_Pos(p1,9);                                                                //得到海拔高度  
  159.         if(posx!=0XFF)gpsx->altitude=NMEA_Str2num(p1+posx,&dx);  
  160. }
  161. //分析GNGSA信息
  162. //gpsx:nmea信息结构体
  163. //buf:接收到的GPS数据缓冲区首地址
  164. void NMEA_GNGSA_Analysis(nmea_msg *gpsx,u8 *buf)
  165. {
  166.         u8 *p1,dx;                        
  167.         u8 posx;
  168.         u8 i;   
  169.         p1=(u8*)strstr((const char *)buf,"$GNGSA");
  170.         posx=NMEA_Comma_Pos(p1,2);                                                                //得到定位类型
  171.         if(posx!=0XFF)gpsx->fixmode=NMEA_Str2num(p1+posx,&dx);        
  172.         for(i=0;i<12;i++)                                                                                //得到定位卫星编号
  173.         {
  174.                 posx=NMEA_Comma_Pos(p1,3+i);                                         
  175.                 if(posx!=0XFF)gpsx->possl[i]=NMEA_Str2num(p1+posx,&dx);
  176.                 else break;
  177.         }                                 
  178.         posx=NMEA_Comma_Pos(p1,15);                                                                //得到PDOP位置精度因子
  179.         if(posx!=0XFF)gpsx->pdop=NMEA_Str2num(p1+posx,&dx);  
  180.         posx=NMEA_Comma_Pos(p1,16);                                                                //得到HDOP位置精度因子
  181.         if(posx!=0XFF)gpsx->hdop=NMEA_Str2num(p1+posx,&dx);  
  182.         posx=NMEA_Comma_Pos(p1,17);                                                                //得到VDOP位置精度因子
  183.         if(posx!=0XFF)gpsx->vdop=NMEA_Str2num(p1+posx,&dx);  
  184. }
  185. //分析GNRMC信息
  186. //gpsx:nmea信息结构体
  187. //buf:接收到的GPS数据缓冲区首地址
  188. void NMEA_GNRMC_Analysis(nmea_msg *gpsx,u8 *buf)
  189. {
  190.         u8 *p1,dx;                        
  191.         u8 posx;     
  192.         u32 temp;           
  193.         float rs;  
  194.         p1=(u8*)strstr((const char *)buf,"$GNRMC");//"$GNRMC",经常有&和GNRMC分开的情况,故只判断GPRMC.
  195.         posx=NMEA_Comma_Pos(p1,1);                                                                //得到UTC时间
  196.         if(posx!=0XFF)
  197.         {
  198.                 temp=NMEA_Str2num(p1+posx,&dx)/NMEA_Pow(10,dx);                 //得到UTC时间,去掉ms
  199.                 gpsx->utc.hour=temp/10000;
  200.                 gpsx->utc.min=(temp/100)%100;
  201.                 gpsx->utc.sec=temp%100;                  
  202.         }        
  203.         posx=NMEA_Comma_Pos(p1,3);                                                                //得到纬度
  204.         if(posx!=0XFF)
  205.         {
  206.                 temp=NMEA_Str2num(p1+posx,&dx);                          
  207.                 gpsx->latitude=temp/NMEA_Pow(10,dx+2);        //得到°
  208.                 rs=temp%NMEA_Pow(10,dx+2);                                //得到'                 
  209.                 gpsx->latitude=gpsx->latitude*NMEA_Pow(10,5)+(rs*NMEA_Pow(10,5-dx))/60;//转换为°
  210.         }
  211.         posx=NMEA_Comma_Pos(p1,4);                                                                //南纬还是北纬
  212.         if(posx!=0XFF)gpsx->nshemi=*(p1+posx);                                         
  213.          posx=NMEA_Comma_Pos(p1,5);                                                                //得到经度
  214.         if(posx!=0XFF)
  215.         {                                                                                                  
  216.                 temp=NMEA_Str2num(p1+posx,&dx);                          
  217.                 gpsx->longitude=temp/NMEA_Pow(10,dx+2);        //得到°
  218.                 rs=temp%NMEA_Pow(10,dx+2);                                //得到'                 
  219.                 gpsx->longitude=gpsx->longitude*NMEA_Pow(10,5)+(rs*NMEA_Pow(10,5-dx))/60;//转换为°
  220.         }
  221.         posx=NMEA_Comma_Pos(p1,6);                                                                //东经还是西经
  222.         if(posx!=0XFF)gpsx->ewhemi=*(p1+posx);        
  223.    posx=NMEA_Comma_Pos(p1,7);              //获取地面速度
  224.         if(posx!=0XFF)gpsx->lspeed=*(p1+posx);        
  225.         
  226.         posx=NMEA_Comma_Pos(p1,9);                                                                //得到UTC日期
  227.         if(posx!=0XFF)
  228.         {
  229.                 temp=NMEA_Str2num(p1+posx,&dx);                                                 //得到UTC日期
  230.                 gpsx->utc.date=temp/10000;
  231.                 gpsx->utc.month=(temp/100)%100;
  232.                 gpsx->utc.year=2000+temp%100;                  
  233.         }
  234. }
  235. //分析GNVTG信息
  236. //gpsx:nmea信息结构体
  237. //buf:接收到的GPS数据缓冲区首地址
  238. void NMEA_GNVTG_Analysis(nmea_msg *gpsx,u8 *buf)
  239. {
  240.         u8 *p1,dx;                        
  241.         u8 posx;   
  242.         p1=(u8*)strstr((const char *)buf,"$GNVTG");                                                         
  243.         posx=NMEA_Comma_Pos(p1,7);                                                                //得到地面速率
  244.         if(posx!=0XFF)
  245.         {
  246.                 gpsx->speed=NMEA_Str2num(p1+posx,&dx);
  247.                 if(dx<3)gpsx->speed*=NMEA_Pow(10,3-dx);                                  //确保扩大1000倍
  248.         }
  249. }  
  250. //提取NMEA-0183信息
  251. //gpsx:nmea信息结构体
  252. //buf:接收到的GPS数据缓冲区首地址
  253. void GPS_Analysis(nmea_msg *gpsx,u8 *buf)
  254. {
  255.         NMEA_GPGSV_Analysis(gpsx,buf);        //GPGSV解析
  256.         NMEA_BDGSV_Analysis(gpsx,buf);        //BDGSV解析
  257.         NMEA_GNGGA_Analysis(gpsx,buf);        //GNGGA解析         
  258.         NMEA_GNGSA_Analysis(gpsx,buf);        //GPNSA解析
  259.         NMEA_GNRMC_Analysis(gpsx,buf);        //GPNMC解析
  260.         NMEA_GNVTG_Analysis(gpsx,buf);        //GPNTG解析
  261. }

  263. /**********************************
  264. 功能：发送数据到GPS模块
  265. 日期：2022.12.14
  266. 参数：cmd AT命令
  267. 返回值： 无
  268. *****************************/
  269. void SendAtToGps(u8 *cmd)
  270. {
  271.   while (*cmd !='\0')
  272.         {
  273.          USART_SendData(USART3,*cmd++);
  274.                 while(USART_GetFlagStatus(USART3,USART_FLAG_TXE)==Bit_RESET);
  275.         }
  276. }


  279. /****************************
  280. 功能：检查GPS模块应答是否符合预期
  281. 日期：2022.12.14
  282. 参数：str 正确应答
  283. 返回值：无
  284. ***************************/
  285. u8 GpsAckChack(u8 *str)
  286. {
  287. //u8 str[225];
  288.         delay_ms(500);
  289. if(USART3_RX_STA !=0)
  290. {
  291.    USART3_RX_STA=0;
  292.          if(strstr ((const char*)USART3_RX_BUF,(const char*)str))
  293.          {
  294.            memset(USART3_RX_BUF,0, sizeof USART3_RX_BUF);  //符合预期
  295.                  return 0;
  296.          }
  297.          else
  298.          {
  299.          memset(USART3_RX_BUF,0, sizeof USART3_RX_BUF);  //不符合预期
  300.                  return 1;
  301.                  //清空数组
  302.          }
  303. }
  304. else
  305. {
  306. memset(USART3_RX_BUF,0, sizeof USART3_RX_BUF);  
  307.          return  1;
  308. }  
  309. }

  311. /*********************************************
  312. 功能：GPS模块初始化
  313. 日期：2022.12.14
  314. 参数： 无
  315. 返回值：无
  316. *********************************************/

  318. void Gps_Init()
  319. {
  320.         cmd1:SendAtToGps (ColdStart); //发送冷启动指令
  321.         delay_ms(50);
  322.         if(!GpsAckChack ("$GNTXT,GK9701*7E..$GNTXT,HW:V190"));
  323.                 else goto cmd1;
  324.         cmd2:SendAtToGps (GPSL1L5); //全系统模式
  325.         delay_ms(50);
  326.         if (!GpsAckChack("$GNTXT,GK9701*7E..$GNTXT,HW:V190"))  ;
  327.           else goto  cmd2;
  328.         cmd3:SendAtToGps(OpenSBAS);    //开启SBAS 功能
  329.              delay_ms(50);        
  330.                          if (!GpsAckChack("$GNTXT,GK9701*7E..$GNTXT,HW:V190"))  ;
  331.              else goto  cmd3;
  332.         cmd4:SendAtToGps(delay1sNMEA); //配置输出 NMEA 消息的间隔 1s
  333.        delay_ms(50);        
  334.              if (!GpsAckChack("$GNTXT,GK9701*7E..$GNTXT,HW:V190"))  ;
  335.              else goto  cmd4;
  336.         cmd5:SendAtToGps(EnableRMC);   //设置 NMEA 语句输出使能  使能RMC
  337.        delay_ms(50);        
  338.              if (!GpsAckChack("$GNTXT,GK9701*7E..$GNTXT,HW:V190"))  ;
  339.              else goto  cmd5;

  341.                          SendAtToGps(MoreFast);//加速定位信息

  343. }
复制代码


Keil代码下载:
AIR551G.7z (6.28 MB, 下载次数: 18)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶顶 踩踩
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表