找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2101|回復: 1
打印 上一主題 下一主題
收起左側(cè)

stm32單片機尋聲小車源程序 用麥克風陣列模塊辨別出聲源的方位

[復制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:609509 發(fā)表于 2022-12-4 23:38 | 只看該作者 回帖獎勵 |倒序瀏覽 |閱讀模式
使用聲音矩陣模塊辨別出聲源的方位，聲音的大小可以反映出小車與聲源的距離。
基于以上兩點在空曠無回音的地點找到聲源，希望感興趣的朋友們可以繼續(xù)完善算法，客服噪聲、回音等等問題
驅(qū)動是用的l298n，加裝了兩個光電傳感器實現(xiàn)尋聲過程中基本避障功能。

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "usart.h"         
  5. #include "adc.h"
  6. #include "dma.h"
  7. #include "moto.h"
  8. #include "pwm.h"
  9. #include "oled.h"
  10. #include "key.h"


  13. float Mv=0; //平均值
  14. int S=0; //模擬聲音大小
  15. float Jvalue(float a);//數(shù)據(jù)處理，類似絕對值
  16.         u16 adcx[6];  //ADC采樣數(shù)組
  17. extern        u8 guangdian;
  18. void Display(void);//顯示

  20. int main(void)//主函數(shù)
  21. {         

  23. //        int i;//循環(huán)變量
  24. //        float adc1,adc2,adc3,adc4,adc5,adc6; //ADC采樣值
  25. //        float v1,v2,v3,v4,v5,v6;//數(shù)據(jù)值
  26.         delay_init();                     //延時函數(shù)初始化         
  27.         SystemInit();        
  28.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//設(shè)置中斷優(yōu)先級分組為組2：2位搶占優(yōu)先級，2位響應優(yōu)先級
  29.         uart_init(115200);                 //串口初始化為115200
  30.          LED_Init();                             //LED端口初始化                        
  31.         MOTO_GPIO_Config();     //電機初始化
  32.         OLED_Init();          //OLED初始化
  33.         KEY_Init();
  34.         OLED_ColorTurn(0);//0正常顯示，1 反色顯示
  35.   OLED_DisplayTurn(0);//0正常顯示 1 屏幕翻轉(zhuǎn)顯示
  36.         GPIO_SetBits(GPIOB,GPIO_Pin_6);  //LED0對應引腳GPIOB.5拉低，亮  等同LED0=0;
  37.         GPIO_SetBits(GPIOB,GPIO_Pin_7);  //LED0對應引腳GPIOB.5拉低，亮  等同LED0=0;
  38.         delay_ms(1000); //延時啟動
  39.         GPIO_ResetBits(GPIOB,GPIO_Pin_7);   //LED1對應引腳GPIOE.5拉高，滅 等同LED1=1;
  40.         delay_ms(1000); //延時啟動
  41.         GPIO_SetBits(GPIOB,GPIO_Pin_6);  //LED0對應引腳GPIOB.5拉低，亮  等同LED0=0;
  42.         GPIO_SetBits(GPIOB,GPIO_Pin_7);  //LED0對應引腳GPIOB.5拉低，亮  等同LED0=0;
  43.         TIM1_PWM_Init(100,36);   //PWM初始化
  44.          MYDMA_Config(DMA1_Channel1,(u32)(&ADC1->DR),(u32)adcx,6);//DMA1通道1,外設(shè)為串口1,存儲器為SendBuff,長度SEND_BUF_SIZE.
  45.         Adc_Init();                                  //ADC初始化
  46.         TIM_SetCompare1(TIM1,25);  //占空比=1-25/100
  47.         TIM_SetCompare3(TIM1,25);
  48.         TIM3_Int_Init(10,35999);
  49.   delay_ms(400); //延時啟動
  50.         while(1) //主循環(huán)
  51.         {
  52. //                v1=0;v2=0;v3=0;v4=0;v5=0;v6=0; //清零
  53. //                for(i=500;i>0;i--) //循環(huán)檢測500次
  54. //                {
  55. //                        adc1=(float)(adcx[0])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  56. //                        v1+=Jvalue(adc1)*0.6;
  57. //                        adc2=(float)(adcx[1])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  58. //                        v2+=Jvalue(adc2);
  59. //                        adc3=(float)(adcx[2])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  60. //                        v3+=Jvalue(adc3);
  61. //                        adc4=(float)(adcx[3])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  62. //                        v4+=Jvalue(adc4);
  63. //                        adc5=(float)(adcx[4])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  64. //                        v5+=Jvalue(adc5)*0.4;
  65. //                        adc6=(float)(adcx[5])*(3.3/4096);          //獲取計算后的帶小數(shù)的實際電壓值，比如3.1111
  66. //                        v6+=Jvalue(adc6);
  67. //                }
  68. //                Mv=(v1+v2+v3+v4+v5+v6)/6; //求平均
  69. ////         Display(); //顯示
  70. ////                delay_ms(2000); //延時啟動
  71. //                if((v1+v2+v3+v4+v5+v6)<120) //太遠
  72. //                {
  73. //                        Car_Stop(); //停車
  74. //                }
  75. //                else if((v1+v2+v3+v4+v5+v6)>1800)//太近
  76. //                {
  77. //                        Car_Stop();
  78. //                }
  79. //                else //正常范圍
  80. //                {
  81. //                        if(1) //聲源在前側(cè)
  82. //                        {
  83. //                                if((v6)>(v2)) //聲源在左邊
  84. //                                {
  85. //                                        Car_Turn_Left();//左轉(zhuǎn)
  86. //                                        S++; //模擬聲音大小值
  87. //                                }
  88. //                                else if((v2)>(v6))//聲源在右邊
  89. //                                {
  90. //                                        Car_Turn_Right(); //右轉(zhuǎn)
  91. //                                        S++;
  92. //                                }
  93. //                                else //聲源在中間
  94. //                                {
  95. //                                        Car_Go(); //前進
  96. //                                        S++;
  97. //                                }
  98. //                        }
  99. //                        else //聲源在后側(cè)
  100. //                        {
  101. //                                Car_RRight();//原地右轉(zhuǎn)
  102. //                        }               
  103. //////      Car_RRight();//原地右轉(zhuǎn)
  104. //////       Car_Go(); //前進
  105. //////     Car_Turn_Left();//左轉(zhuǎn)
  106. ////        Car_Turn_Right(); //右轉(zhuǎn)
  107. //                }        
  108.         }
  109. }

  111. float Jvalue(float a) //數(shù)據(jù)處理，將正負變換的數(shù)據(jù)轉(zhuǎn)換成正誤差
  112. {
  113.         float b;
  114.         if(a>=1.65)
  115.         {
  116.                 b=a-1.65;
  117.         }
  118.         else
  119.         {
  120.                 b=1.65-a;
  121.         }
  122.         return b;
  123. }

  125. void Display(void)//數(shù)據(jù)顯示
  126. {
  127.         OLED_ShowChinese(0,1,18,16,1);//"聲"
  128.         OLED_ShowChinese(18,1,19,16,1);//"音"
  129.         OLED_ShowChinese(36,1,9,16,1);//":"
  130.         OLED_ShowNum(45,1,Mv,4,16,1);
  131.         OLED_ShowChar(80,1,'d',16,1);
  132.         OLED_ShowChar(90,1,'B',16,1);
  133.         OLED_ShowChinese(0,20,0,16,1);//"路"
  134.         OLED_ShowChinese(18,20,1,16,1);//"程"
  135.         OLED_ShowChinese(36,20,2,16,1);//":"
  136.         OLED_ShowNum(45,20,S,4,16,1);
  137.         OLED_ShowChar(80,20,'c',16,1);
  138.         OLED_ShowChar(89,20,'m',16,1);
  139.         
  140.         OLED_ShowNum(45,40,guangdian,4,16,1);
  141.         OLED_Refresh();//更新顯存到OLED        
  142. }
復制代碼

Keil代碼下載:
程序源碼.7z (222.8 KB, 下載次數(shù): 31)

評分

參與人數(shù) 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵！

查看全部評分

分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏3 分享淘帖 頂頂 踩踩
回復

使用道具 舉報

沙發(fā)
ID:822053 發(fā)表于 2023-10-10 11:27 | 只看該作者
樓主原理圖
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機教程網(wǎng)

快速回復 返回頂部 返回列表