標(biāo)題: STM32F103VET6超聲波測(cè)距源碼 [打印本頁(yè)]
作者: 單片機(jī)小白一個(gè)    時(shí)間: 2019-8-6 08:35
標(biāo)題: STM32F103VET6超聲波測(cè)距源碼
模塊名稱：HY-SRF05
工作原理：給TRIG引腳至少10us高電平后，該模塊立即發(fā)出8個(gè)40KHZ的方波，之后，ECHO引腳立馬變?yōu)楦唠娖�，發(fā)出的方波返回后，ECHO引腳變?yōu)榈碗娖�，因此，測(cè)量距離的關(guān)鍵即為測(cè)量ECHO引腳高電平時(shí)間，我試了延時(shí)和定時(shí)器兩種 ，輸入捕獲應(yīng)該也可以
核心代碼，定時(shí)器版本
float Hcsr04GetLength(void )
{
                    int i = 0;
                                int t=0;
        float lengthTemp = 0;
        float sum = 0;
        while(i!=5)
        {
                                        TRIG_Send = 1;      //發(fā)送口高電平輸出
                                        delay_us(20);
                                        TRIG_Send = 0;
                                        while(ECHO_Reci == 0);      //等待接收口高電平輸出
                                        OpenTimerForHc();        //打開(kāi)定時(shí)器                        
                                        while(ECHO_Reci == 1);
                                        CloseTimerForHc();        //關(guān)閉定時(shí)器        
                                        i = i + 1;
                                        t = GetEchoTimer();        //獲取時(shí)間,分辨率為1US
                                        lengthTemp = ((float)t/58.0);//cm
                                         sum = lengthTemp + sum ;
        }

        lengthTemp = sum/5.0;
        return lengthTemp;
}

延時(shí)版本
float Hcsr04GetLength(void)
{
        u32 t = 0;
        int i = 0;
        float lengthTemp = 0;
        float sum = 0;
        while(i!=5)
        {
                                        t=0;
                                        ECHO_Reci=0;
                                        TRIG_Send = 1;      //發(fā)送口高電平輸出
                                        delay_us(10);
                                        TRIG_Send = 0;
                                        while(ECHO_Reci == 0);      //等待接收口高電平輸出
                                        while(ECHO_Reci==1)
                                        {
                                                 delay_us(1);//精度
                                                 t++;
                                        }
                                        i = i + 1;               
                                        lengthTemp = ((float)t/58);//cm
                                        sum = lengthTemp + sum ;
        }
        lengthTemp = sum/5.0;
        return lengthTemp;
}

完整代碼已打包為一個(gè)壓縮包 01.7z (186.74 KB, 下載次數(shù): 48)




歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1