GPS两点测距精度问题

huangchangxin10

我的GPS是从原子哥这买的，最近做毕设，做的是GSM和GPS汽车防盗系统，我发现GPS测量两点之间的距离要超过38.3125米才能分辨出来（也就是不在是0了），我的思路是，GPS启动完成后，用个外部中断摁键记录当前的经纬度坐标（分别sheding_jingdu,sheding_weidu来表示停车位置），然后，人工模拟汽车被移动（GPS实时获得此时的xianzai_jingdu,xianzai_weidu），并实时计算此时的位置和停车位置之间的距离。

[mw_shl_code=c,true]float GPs_count(void) { float MLatA,MLatB;//MlatA是设定的纬度值计算式子里的形式，同理MlatB是现在车辆的实时纬度值得计算式子里的形式 float MLonA,MLonB;//MLonA设定的经度值，东经取正数,西经取负。 float C; MLatA=90-sheding_weidu;//设定的纬度 MLatB=90-xianzai_weidu;//现在的纬度 MLonA=sheding_jingdu;//设定的经度 MLonB=xianzai_jingdu;//设定的纬度 C=sin(MLatA)*sin(MLatB)*cos(MLonA- MLonB)+cos(MLatA)*cos(MLatB); Distance=1000.00000*R*acosf(C)*Pi/180.00000; // 千米*1000化成米为单位 sprintf((char *)dtbuf,"Distance:%.5f %1c ",Distance,'m'); //得到经度字符串 LCD_ShowString(30,64,dtbuf,GREEN,BLACK); //显示实际停车位置和当前的车辆位置之间的距离 return Distance; }[/mw_shl_code]

上面这个函数的由来，来源于我下面这张图，网址http://blog.csdn.net/lfqsy/article/details/6750537   ，原子哥有什么好思路么。急求，快答辩咯

正点原子

这个没什么好办法哦
看你的定位质量，经纬度应该是一直抖动的，你的会一直是一个值？？

huangchangxin10

回复【2楼】正点原子:
---------------------------------
我的确实不是一个 定值，但是停车位置固定（由摁键设定），车辆移动肯定会变化，我就在原子哥你这个void Gps_Msg_Show(void)函数里每次都调用距离计算函数float GPs_count(void)，但是发现精度没想象中的10米，晚上10点多的时候，我发现一个更糟的结果，我回到原来的位置，经度差值居然差了0.00007°，1经度85.39km，那么距离居然差了5.9773米。纬度差值为0     .我的经纬度差值实时显示在lcd上面。后来我干脆这么想，你不是1经度85.39km么，1纬度大约111km ，于是我直接用上面的Distance1=（经度差值*85.39）*1000米，Distance2=(纬度差值*111)*1000,结果距离值就不再从零 开始了，每次都有读数。但是跳变得厉害，，，，有什么解决办法能稳定一下数值么

盒子

做做 滤波了么

huangchangxin10

回复【4楼】盒子:
---------------------------------
没研究过率滤波算法，能给说说思路么

huangchangxin10

回复【5楼】huangchangxin10:
---------------------------------
回复【2楼】正点原子:
---------------------------------现在找到个好一点的办法，就是用去除那些跳变得厉害的的经纬度，然后这样
//显示GPS定位信息
void Gps_Msg_Show(void)
{
  float tp;     
tp=gpsx.longitude;

xianzai_jingdu=tp/100000.00000;//记录当前经度，东经多少度?
if(((fabs(xianzai_jingdu-sheding_jingdu))>0.0018)&&(sheding_jingdu!=0))  //预防错误的发生，判断是不是超过了0.01度经度，如果是则把前一个正确的结果赋给xianzai_jingdu
{
xianzai_jingdu=previous_jingdu;
}
previous_jingdu=xianzai_jingdu;   //记录先前的经度，方便处理错误的经度值（由于GPS存在有时候定位不了的错误）

sprintf((char *)dtbuf,"Longitude:%.5f %1c   ",tp/=100000,gpsx.ewhemi); //得到经度字符串
  LCD_ShowString(30,130,dtbuf,BLACK,BLUE);

tp=gpsx.latitude;
xianzai_weidu=tp/100000.00000;   //记录当前纬度值,北纬多少度？
if(((fabs(xianzai_weidu-sheding_weidu))>0.0018)&&(sheding_weidu!=0))
{
xianzai_weidu=previous_weidu;   //如果现在纬度和设定的纬度差值大于0.0018说明现在纬度值无效，把以前的值赋给xianzai_weidu            
}
previous_weidu=xianzai_weidu;         //记录先前的纬度，方便处理错误的纬度值。

sprintf((char *)dtbuf,"Latitude:%.5f %1c   ",tp/=100000,gpsx.nshemi); //得到纬度字符串


  LCD_ShowString(30,150,dtbuf,BLACK,BLUE);    
tp=gpsx.altitude;    
  sprintf((char *)dtbuf,"Altitude:%.1fm     ",tp/=10);      //得到海拔高度
  LCD_ShowString(30,170,dtbuf,BLACK,BLUE);      
tp=gpsx.speed;    
  sprintf((char *)dtbuf,"Speed:%.3fkm/h     ",tp/=1000);      //得到速度字符串
  LCD_ShowString(30,190,dtbuf,BLACK,BLUE);       
if(gpsx.fixmode<=3) //定位状态
{  
sprintf((char *)dtbuf,"Fix Mode:%s",fixmode_tbl[gpsx.fixmode]);
   LCD_ShowString(30,210,dtbuf,BLACK,BLUE);    
}      
sprintf((char *)dtbuf,"Valid satellite:%02d",gpsx.posslnum);   //用于定位的卫星数目
  LCD_ShowString(30,230,dtbuf,BLACK,BLUE);     
sprintf((char *)dtbuf,"Visible satellite:%02d",gpsx.svnum%100);   //可见卫星数
  LCD_ShowString(30,250,dtbuf,BLACK,BLUE);  
sprintf((char *)dtbuf,"UTC Date:%04d/%02d/%02d   ",gpsx.utc.year,gpsx.utc.month,gpsx.utc.date); //显示UTC日期
//printf("year2:%d\r\n",gpsx.utc.year);
LCD_ShowString(30,270,dtbuf,BLACK,BLUE);     
sprintf((char *)dtbuf,"UTC Time:%02d:%02d:%02d   ",gpsx.utc.hour,gpsx.utc.min,gpsx.utc.sec); //????UTC?±??
  LCD_ShowString(30,290,dtbuf,BLACK,BLUE);

//显示设定经纬度（停车位置）
sprintf((char *)dtbuf,"sheding jingdu:%.5f %1c   ",sheding_jingdu,'N'); //得到经度字符串
LCD_ShowString(30,0,dtbuf,BLACK,BLUE);
sprintf((char *)dtbuf,"sheding weidu:%.5f %1c   ",sheding_weidu,'E'); //得到纬度字符串
LCD_ShowString(30,16,dtbuf,BLACK,BLUE);

//显示设定值和当前值的差值
sprintf((char *)dtbuf,"chazhi jingdu:%.5f %1c   ",fabs(sheding_jingdu-xianzai_jingdu),'N'); //fabs为取绝对值的函数，得到经度差值
LCD_ShowString(30,32,dtbuf,RED,BLUE);
sprintf((char *)dtbuf,"chazhi weidu:%.5f %1c   ", fabs(sheding_weidu-xianzai_weidu),'E'); //fabs为取绝对值的函数，得到纬度差值
LCD_ShowString(30,48,dtbuf,RED,BLUE);

//计算并显示当前的车辆位置和设定的位置之间的距离

Distance1=fabs(sheding_jingdu-xianzai_jingdu)*100353.16000;   //经度相差1度，为100353.16000米

sprintf((char *)dtbuf,"Distan1_E:%.5f %1c       ",Distance1,'m'); //得到经度字符串
LCD_ShowString(30,64,dtbuf,GREEN,BLUE);

Distance2=fabs(sheding_weidu-xianzai_weidu)*111000.00000;//纬度相差一度为111000.00000米，由纬度算出来的值,单位为米
sprintf((char *)dtbuf,"Distan2_N:%.5f %1c       ",Distance2,'m'); //得到纬度字符串
LCD_ShowString(30,80,dtbuf,GREEN,BLUE);

LCD_ShowString(30,96,"GSM&&GPS BY WEI CHANG MAO",BLACK,BLUE);
//GPs_count();
//LCD_ShowString(30,112,"                          ",BLACK,BLUE);
//if((xianzai_jingdu>(sheding_jingdu+xianzhi))||(xianzai_jingdu<(sheding_jingdu-xianzhi))||(xianzai_weidu>(sheding_weidu+xianzhi))||(xianzai_weidu<(sheding_weidu-xianzhi)))
if(Distance1>30||Distance2>30)   //实际测量值测量值，有待测量.
{
// if(send_flag==1)
// {
// sim900a_sms_send_test();
// send_flag=0;   //报警标志置0,只发一次短信就不再发送,信息费好贵的说
// }
for(t=0;t<10;t++)
{
led=!led;
delay_ms(500);
}
 }
else
{
led=1;
beep=0;
}

delay_ms(100);

/* current=sim900a_sms_read_num();  //获取当前的短信数目

if(current==previous)           //当前的短信数目和以前的短信数目比较，数目不变，不读取短信,else读取短信
{
//不读取短信

}
else   //短信增加了,读取短信内容并判断，是否是车主发的
{
   //读取短信并判断内容
table_current[0]=current/10+'0';
table_current[1]=current%10+'0';
table_current[2]='\0';
 
sim900a_sms_read_test(table_current);
previous=current;   //改变短信数目。标记新短信已经读过了

}
*/


}  那些注释掉的是为了方便调试GPS，所以把GSM部分注释掉了

huangchangxin10

回复【6楼】huangchangxin10:
---------------------------------
想想，好像可以用勾股定理，因为报警的距离不超过50米，而地球这么大，类似一个知道两直角边求第三边的几何运算，呵呵

huangchangxin10

大家可以一起来讨论讨论啊，开阔思维，嘿嘿，程序员就怕没思路

蜕变

有没有试过这种办法，误差比你那种大吗？今天在百度地图拾取坐标计算了下，这种精度不高，误差几十米？你那种你试过吗，误差有多少？
还有就是你不做方向定位吗？就是现在点与原始点的连线方向与真北或磁北的夹角，如果有做，有什么思路方法吗？我是做飞控的，也要用到GPS这块。

longjun3121

这是个好帖，最近有可能用到。

a20084666

哥们把你的程序都放上来吧

xiaoyehack

哥们  你问题解决了吗？  遇到跟你一样的问题

春夜喜小雨

mark一下看看  我以后也要用这个，我想问一下原子哥给的解析经纬度的程序是不是就是十进制的，不是N31°53′10.23″ 东经E118°48′54.36形式啊~~~应该是换算过来的吧~@正点原子

yuzeyuan1

春夜喜小雨 发表于 2016-8-30 16:34
mark一下看看  我以后也要用这个，我想问一下原子哥给的解析经纬度的程序是不是就是十进制的，不是N31°53 ...

我记得经纬度本来读出来就不是N31°53′10.23″的形式，而是11848.76589...这种形式，你自己转一下就好

春夜喜小雨

yuzeyuan1 发表于 2016-8-30 17:59
我记得经纬度本来读出来就不是N31°53′10.23″的形式，而是11848.76589...这种形式，你自己转一下就好

所以我觉得是度，不是度分秒~

ganshuaiqi

帮顶，目前我也遇到了GPS模块经纬度误差问题~