gps测距，经纬度通过公式换算成距离后数据不对，请大家帮忙看看是哪里出错了！谢谢

小飞流123

数据输入

公式换算

公式在excl里面能正常使用

串口接收数据

使用gps测两个经纬度之间的直线距离，但是输出不对，一直都是0。请大家帮忙看看是哪里出错了？
公式：=6371004*ACOS(SIN(B2*PI()/180)*SIN(D2*PI()/180)*COS((C2-A2)*PI()/180)+COS(B2*PI()/180)*COS(D2*PI()/180))
A2：经度1
B2：纬度1 GPS模块实验.zip (6.18 MB, 下载次数: 180)

2016-11-16 11:22 上传

点击文件名下载附件
附上源代码





C2：经度2
D2：纬度2
PI（）：3.1415926

这个公式在excl表格里面都可以正常使用，但是换成程序就不对了，输出为0。

double  jsjl(u32 jd1,u32 wd1,u32 jd2,u32 wd2)
{
        double  jingdu1,weidu1,jingdu2,weidu2,hd_a,hd_b,hd_c,hd_d,po1,po2,po3,JL;
               
        jingdu1=jd1/100000;
        jingdu2=jd2/100000;
        weidu1=wd1/100000;
        weidu2=wd2/100000;
        hd_a=jingdu1*3.1415926/180;       
        hd_b=weidu1*3.1415926/180;       
        hd_c=jingdu2*3.1415926/180;       
        hd_d=weidu2*3.1415926/180;       
        po1=sin(hd_b)*sin(hd_d)*cos(hd_c-hd_a)+cos(hd_b)*cos(hd_d);
        JL=6371004*acos(po1);
        printf("\r\njuli:%.1fm\r\n",JL);//·￠Ëí½óêÕμ½μÄêy¾Yμ½′®¿ú1
        printf("po1:%.5f\r\n",po1);//·￠Ëí½óêÕμ½μÄêy¾Yμ½′®¿ú1
                return JL;
}       




int main(void)
{
        u16 i,rxlen;
        u16 lenx;
        u8 key=0XFF;
u8 upload=0,upload2=0,tt=0;
        double  jdd1,jdd2,wdd1,wdd2,cc;
        NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//éèÖÃÏμí3ÖD¶ÏóÅÏ輶·Ö×é2
        delay_init(168);              //3õê¼»ˉÑóê±oˉêy
        uart_init(115200);                        //3õê¼»ˉ′®¿ú2¨ìØÂêÎa115200
        usart3_init(38400);                        //3õê¼»ˉ′®¿ú32¨ìØÂêÎa38400
        usmart_dev.init(84);                 //3õê¼»ˉUSMART               
        LED_Init();                                        //3õê¼»ˉLED
        KEY_Init();                                        //3õê¼»ˉ°′¼ü
        LCD_Init();                                         //3õê¼»ˉLCD
        usmart_dev.init(72);                 //3õê¼»ˉUSMART           
        POINT_COLOR=RED;
        LCD_ShowString(30,20,200,16,16,"ALIENTEK STM32F4 ^_^");       
        LCD_ShowString(30,40,200,16,16,"NE0-6M GPS TEST");       
        LCD_ShowString(30,60,200,16,16,"ATOM@ALIENTEK");
        LCD_ShowString(30,80,200,16,16,"KEY0:Upload NMEA Data SW");                                                                                                         
  LCD_ShowString(30,100,200,16,16,"NMEA Data Upload:OFF");  
        LCD_ShowString(30,340,200,16,16,"ce liang ju li:OFF");       
        if(Ublox_Cfg_Rate(1000,1)!=0)        //éèÖö¨Î»DÅÏ￠¸üDÂËù¶èÎa1000ms,Ë3±ãÅD¶ÏGPSÄ￡¿éêÇ·ñÔúλ.
        {
                   LCD_ShowString(30,120,200,16,16,"NEO-6M Setting...");
                while((Ublox_Cfg_Rate(1000,1)!=0)&&key)        //3ÖDøÅD¶Ï,Ö±μ½¿éòÔ¼ì2éμ½NEO-6M,Çòêy¾Y±￡′æ3é1|
                {
                        usart3_init(9600);                                //3õê¼»ˉ′®¿ú32¨ìØÂêÎa9600(EEPROMûóD±￡′æêy¾YμÄê±oò,2¨ìØÂêÎa9600.)
                          Ublox_Cfg_Prt(38400);                        //ÖØDÂéèÖÃÄ￡¿éμÄ2¨ìØÂêÎa38400
                        usart3_init(38400);                                //3õê¼»ˉ′®¿ú32¨ìØÂêÎa38400
                        Ublox_Cfg_Tp(1000000,100000,1);        //éèÖ&#195PSÎa1ÃëÖóêä3ö1′Î,Âö3å¿í¶èÎa100ms            
                        key=Ublox_Cfg_Cfg_Save();                //±￡′æÅäÖà 
                }                                                   
                   LCD_ShowString(30,120,200,16,16,"NEO-6M Set Done!!");
                delay_ms(500);
                LCD_Fill(30,120,30+200,120+16,WHITE);//Çå3yÏÔê¾
        }
        while(1)
        {               
                delay_ms(1);
                if(USART3_RX_STA&0X8000)                //½óêÕμ½ò»′Îêy¾YáË
                {
                        rxlen=USART3_RX_STA&0X7FFF;        //μÃμ½êy¾Y3¤¶è
                        for(i=0;i<rxlen;i++)USART1_TX_BUF=USART3_RX_BUF;          
                        USART3_RX_STA=0;                           //&#198;&#244;&#182;ˉ&#207;&#194;ò&#187;′&#206;&#189;óê&#213;
                        USART1_TX_BUF=0;                        //×&#212;&#182;ˉìí&#188;ó&#189;áê&#248;·&#251;
                        GPS_Analysis(&gpsx,(u8*)USART1_TX_BUF);//·&#214;&#206;&#246;×&#214;·&#251;′&#174;
                       
                        if(upload2==1&&tt==1)
                        {LED1=!LED1;
                                jdd1=10380993;//gpsx.longitude;
                                wdd1=3070175;//gpsx.latitude;
                                tt=0;                               
                        }else if(upload2==0&&tt==2)
                        {
                                LED1=!LED1;
                                tt=0;
                                jdd2=10380993;//gpsx.longitude;
                                wdd2=3070176;//gpsx.latitude;
                               
                                cc=jsjl(jdd1,wdd1,jdd2,wdd2);
                                printf("\r\njuli:%.1fm\r\n",cc);//·￠&#203;í&#189;óê&#213;μ&#189;μ&#196;êy&#190;Yμ&#189;′&#174;&#191;ú1
                                sprintf((char *)dtbuf,"juli:%.1fm     ",cc);                                    //μ&#195;μ&#189;&#190;àà&#235;×&#214;·&#251;′&#174;
                                LCD_ShowString(30,470,200,16,16,dtbuf);                                                                   
                        }                       
                        Gps_Msg_Show();                                //&#207;&#212;ê&#190;D&#197;&#207;￠       
                       
                        if(upload)printf("\r\n%s\r\n",USART1_TX_BUF);//·￠&#203;í&#189;óê&#213;μ&#189;μ&#196;êy&#190;Yμ&#189;′&#174;&#191;ú1
                }
                key=KEY_Scan(0);
                if(key==KEY0_PRES)
                {
                        upload=!upload;
                        POINT_COLOR=RED;
                        if(upload)LCD_ShowString(30,100,200,16,16,"NMEA Data Upload:ON ");
                        else LCD_ShowString(30,100,200,16,16,"NMEA Data Upload:OFF");
                }else if(key==KEY1_PRES)
                {
                        upload2=!upload2;
                        //POINT_COLOR=MAGENTA;
                        if(upload2)
                        {
                                tt=1;
                                LCD_ShowString(30,340,200,16,16,"ce liang ju li:ON ");
                       
                        }
                        else
                        {
                                tt=2;
                                LCD_ShowString(30,340,200,16,16,"ce liang ju li:OFF");
                       
                        }
               
                }
                if((lenx%500)==0)LED0=!LED0;                                              
                lenx++;       
        }                                                                            
}

小飞流123

修改了这些地方：jingdu1=(double)jd1/100000;         jingdu2=(double)jd2/100000;         weidu1=(double)wd1/100000;         weidu2=(double)wd2/100000;

正点原子

帮顶

小飞流123

问题找到了，是数据类型没有转换过来，强制转换一下就好了

langxing08

小飞流123 发表于 2016-11-16 11:24
修改了这些地方：jingdu1=(double)jd1/100000;         jingdu2=(double)jd2/100000;         weidu1=(double)wd1/100000; ...

就是数据格式的问题。
也可以这样：
jingdu1=jd1/100000.0;        
jingdu2=jd2/100000.0;        
weidu1=wd1/100000.0;         
weidu2=wd2/100000.0;

100000.0就是浮点数了。