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

標題: STM32智能小車超聲波跟隨的程序源碼 [打印本頁]
作者: zsmart    時間: 2018-7-16 09:29
標題: STM32智能小車超聲波跟隨的程序源碼
  1. #include "stm32f10x.h"
  2. #include "delay.h"
  3. #include "motor.h"
  4. #include "keysacn.h"
  5. #include "IRSEARCH.h"
  6. #include "IRAvoid.h"
  7. #include "usart.h"
  8. #include "UltrasonicWave.h"
  9. #include "timer.h"
  10. #include "Server.h"



  14. char ctrl_comm1 = COMM_STOP;//控制指令
  15. char ctrl_comm1_last = COMM_STOP;//上一次的指令
  16. int Q_temp,Q_temp_last,L_temp,R_temp;

  18. // 超聲波轉頭函數
  19. int front_detection()
  20. {

  22. //        ZYSTM32_brake(0);
  23.         SetJointAngle(90);
  24.         delay_ms(100);
  25.         return UltrasonicWave_StartMeasure();
  26. }
  27. int left_detection()
  28. {

  30. //        ZYSTM32_brake(0);
  31.         SetJointAngle(175);
  32.         delay_ms(300);
  33.         return UltrasonicWave_StartMeasure();
  34. }
  35. int right_detection()
  36. {

  38. //        ZYSTM32_brake(0);
  39.         SetJointAngle(5);
  40.         delay_ms(300);
  41.         return UltrasonicWave_StartMeasure();
  42. }


  45. void BarrierProc(void)
  46. {
  47.    delay_ms(10);
  48.          Q_temp_last = Q_temp;
  49.          Q_temp = front_detection();
  50.          printf("測到的距離值為：%d\n",Q_temp);
  51.       
  52.          if( Q_temp > 45)
  53.         {
  54.                 ctrl_comm1 = COMM_STOP;//防震蕩
  55.                 return;
  56.         }
  57.       
  58.         if((Q_temp_last > Q_temp)&&(Q_temp<=15)) ctrl_comm1 = COMM_DOWN;
  59.         //if(Q_temp<=15) ctrl_comm1 = COMM_DOWN;
  60.         if(Q_temp >=30) ctrl_comm1 = COMM_UP;
  61. }
  62. //extern int U_temp;
  63. /*
  64. void ZYSTM32_run(int speed,int time);       //前進函數
  65. void ZYSTM32_brake(int time);               //剎車函數
  66. void ZYSTM32_Left(int speed,int time);      //左轉函數
  67. void ZYSTM32_Spin_Left(int speed,int time); //左旋轉函數
  68. void ZYSTM32_Right(int speed,int time);     //右轉函數
  69. void ZYSTM32_Spin_Right(int speed,int time);//右旋轉函數
  70. void ZYSTM32_back(int speed,int time);      //后退函數
  71. */

  73. int main(void)
  74. {      

  76.          delay_init();
  77.          KEY_Init();
  78.          IRSearchInit();
  79.          IRAvoidInit();
  80.    Timerx_Init(5000,7199);                //10Khz的計數頻率，計數到5000為500ms
  81.          UltrasonicWave_Configuration();        //對超聲波模塊初始化
  82.          uart_init(115200);
  83.          TIM4_PWM_Init(7199,0);                 //初始化PWM
  84.          TIM5_PWM_Init(9999,143);               //不分頻，PWM頻率=72*10^6/(9999+1)/(143+1)=50Hz         
  85.          ZYSTM32_brake(500);
  86.          keysacn();               
  87.         while(1)
  88.         {         
  89.     BarrierProc();
  90.                
  91.         //        Q_temp = front_detection();
  92.         //  printf("測到的距離值為：%d\n",Q_temp);
  93.         //Q_temp_last = Q_temp;
  94.                 //Q_temp = front_detection();
  95.                         if(ctrl_comm1_last != ctrl_comm1)
  96.                         {
  97.                                 ctrl_comm1_last = ctrl_comm1;
  98.                                 switch(ctrl_comm1)
  99.                                 {
  100.                                         case COMM_UP:   ZYSTM32_run(50,10);break;
  101.                                         case COMM_DOWN:  ZYSTM32_back(50,500);        break;
  102.                                         case COMM_LEFT:  ZYSTM32_Left(50,700);break;
  103.                                         case COMM_RIGHT:ZYSTM32_Right(50,700);break;
  104.                                         case COMM_STOP:  ZYSTM32_brake(500);break;
  105.                                         default : break;
  106.                                 }
  107.                         }
  108.                
  109.                
  110.                 }
  111. }


復制代碼

全部資料51hei下載地址：
ZYSTM32-A0 智能小車超聲波避障實驗(有舵機).rar (311.8 KB, 下載次數: 89)
作者: ckeai    時間: 2018-12-9 20:58
新手求教 1.u_temp = UltrasonicWave_Distance*10;u_temp難道不是距離嗎？為什么不是直接賦值UltrasonicWave_Distance，還有乘以10
2.         Q_temp_last = Q_temp;
         Q_temp = front_detection();沒明白
3.為啥同樣是轉頭SetJointAngle（）里的值還不一樣
4。SetJointAngle（）；這個函數沒看懂
作者: vuckil    時間: 2018-12-24 20:02
參考學習下



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