欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

標題: 我用超聲波控制高度飛行的時候發現不能實現雙旋翼的高度控制，請幫忙一下 [打印本頁]
作者: 楓葉獨眠    時間: 2018-8-5 01:13
標題: 我用超聲波控制高度飛行的時候發現不能實現雙旋翼的高度控制，請幫忙一下
我用超聲波控制高度飛行的時候發現不能實現雙旋翼的高度控制

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "timer.h"
  5. #include "usart.h"
  6. #include "ceju.h"


  9. //接線說明echo-PA0；trig-PA1；vcc接5v
  10. //TM3使超聲波每隔一秒發送，TM2輸入捕獲。
  11. extern u16 *p1;
  12. extern u8 kaishi;
  13. extern u16 *p2;
  14. extern float Distance;
  15. extern u8  TIM2CH1_CAPTURE_STA;                //輸入捕獲狀態                                                   
  16. extern u16        TIM2CH1_CAPTURE_VAL;        //輸入捕獲值
  17. int main(void)
  18. {       
  19.         u16 a=0,b=115,count1=115,count2=115,c;

  21.         u32 temp=0;
  22.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);// 設置中斷優先級分組2
  23.         delay_init();                     //延時函數初始化       
  24.         uart_init(115200);                                 //9600         
  25.         LED_Init();                          //初始化與LED連接的硬件接口
  26.         GPIO_Config() ;
  27.         TIM3_Int_Init(1999,719);                //一秒發送一次。4999*2,7199       
  28.         //TIM3_Config(1999,719);
  29.         TIM3_IRQHandler();
  30.         TIM2_Cap_Init(0XFFFF,7199);                //以10khz的頻率計數  
  31.         ceju_Init();
  32.        
  33.         TIM_SetCompare1(TIM3,80);        //初始化占空比要在4%左右
  34.   TIM_SetCompare2(TIM3,80);
  35.          delay_ms(1500);
  36.          delay_ms(1500);
  37.          delay_ms(1500);
  38.          delay_ms(1500);
  39.          p1=&count1;
  40.         while (1)
  41. {
  42.            ceju_Init();
  43.            delay_ms(5);  
  44.          if(TIM2CH1_CAPTURE_STA&0X80)//成功捕獲到了一次高電平
  45.          {
  46.                   temp=TIM2CH1_CAPTURE_STA&0X3F;
  47.                         temp*=65536;                                        //溢出時間總和
  48.                         temp+=TIM2CH1_CAPTURE_VAL;                //得到總的高電平時間
  49.                         Distance=temp*5*34*2/200.0;   //離地高度  cm
  50.                  if(Distance<40)
  51.                  {
  52.                             TIM_SetCompare1(TIM3,count1+=0.5);               
  53.                                         TIM_SetCompare2(TIM3,count2+=0.5);       
  54.                             delay_ms(20);
  55.                  }
  56.                  else {
  57.                       TIM_SetCompare1(TIM3,count1-=0.5);               
  58.                                         TIM_SetCompare2(TIM3,count2-=0.5);       
  59.                             delay_ms(20);
  60.                  }

  62.           TIM2CH1_CAPTURE_STA=0;                        //開啟下一次捕獲
  63.          }
  64. }
  65. }
復制代碼

所有資料51hei提供下載:
超聲波捕獲測距實驗.rar (293.96 KB, 下載次數: 7)



99999.PNG (27.05 KB, 下載次數: 45)

99999.PNG
作者: yzwzfyz    時間: 2018-8-5 09:33
控制問題是一個系統問題，與控制方案有關。先說一下你的控制原理與方案。
作者: 楓葉獨眠    時間: 2018-8-5 11:37
yzwzfyz 發表于 2018-8-5 09:33
控制問題是一個系統問題，與控制方案有關。先說一下你的控制原理與方案。

我是想每次捕獲的脈沖轉化成Distance距離之后，如果小于40cm就電機的占空比就進行增量運算，大于就做減法運算。來控制雙旋翼的高度，但是總會有好多問題，我也才學stm32大半個月，很多問題我察覺不出來。能請你幫忙看一下嗎？




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