标题: stm32f103ze电磁循迹超声波避障停车源程序 [打印本页]
作者: 狄利克雷    时间: 2021-5-21 16:48
标题: stm32f103ze电磁循迹超声波避障停车源程序
采用三个电感循迹和超声波避障
制作出来的实物图如下：


单片机源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "key.h"
  4. #include "sys.h"
  5. #include "usart.h"
  6. #include "timer.h"
  7. #include "moto.h"
  8. #include "pwm.h"
  9. #include "lcd.h"

  11. #define Trig PGout(1)                //PC1        TRIG
  12. //函数声明
  13. void UltrasonicWave_Configuration(void);
  14. void UltrasonicWave_StartMeasure(void);
  15. void TIM5_Int_Init(u16 arr,u16 psc);
  16. extern int Sensor_Left,Sensor_Middle,Sensor_Right;//电磁巡线相关
  17. extern float Velocity_KP,Velocity_KI,Sensor,sum;               //速度控制PID参数
  18. extern float Velocity,Velocity_Set,Turn,Angle_Set;
  19. extern int Motor_A,Motor_B,Servo,Target_A,Target_B;  //电机控制相关
  20. extern int Encoder_Left,Encoder_Right;             //左右编码器的脉冲计数

  22. extern u8  TIM5CH1_CAPTURE_STA;                //输入捕获状态                                                   
  23. extern u16        TIM5CH1_CAPTURE_VAL;        //输入捕获值        

  25. //void TIM3_Int_Init(u16 arr,u16 psc);

  27. void UltrasonicWave_Configuration(void)
  28. {
  29.         GPIO_InitTypeDef GPIO_InitStructure;
  30.         
  31.         RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOG, ENABLE);

  33.         GPIO_InitStructure.GPIO_Pin = GPIO_Pin_1;                                         
  34.         GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;                  
  35.         GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;                 
  36.         GPIO_Init(GPIOG, &GPIO_InitStructure);                       
  37. }
  38. void UltrasonicWave_StartMeasure(void)
  39. {
  40.         Trig = 1;
  41.         delay_us(20);                                      //??20US
  42.         Trig = 0;
  43.         
  44. }
  45. int main(void)
  46. {               
  47.   u32 temp=0;
  48.         float UltrasonicWave_Distance=0;      //计算出的距离
  49.         delay_init();                     //延时函数初始化         
  50.         Encoder_Init_TIM2();            //=====编码器接口
  51.         delay_ms(100);
  52.         Encoder_Init_TIM3();            //=====初始化编码器
  53.   delay_ms(100);         
  54.   Motor_PWM_Init(7199,0);                                  //=====初始化PWM 10KHZ，用于驱动电机
  55.         delay_ms(100);
  56.          NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
  57.         UltrasonicWave_Configuration();
  58.         TIM5_Cap_Init(0XFFFF,72-1);        //以1Mhz的频率计数
  59.         ele_Init();  //=====电磁传感器初始化
  60.         delay_ms(100);
  61.         
  62.          LED_Init();                             //LED端口初始化
  63.         LCD_Init();
  64.                  
  65.         POINT_COLOR=RED;
  66.         delay_ms(100);
  67.         //TIM5_Int_Init(5000,71);//10Khz的计数频率，计数到5000为500ms
  68. delay_ms(100);         
  69.            while(1)
  70.         {
  71.                 UltrasonicWave_StartMeasure();//开始测距
  72.                 if(TIM5CH1_CAPTURE_STA&0X80)//成功捕获到了一次上升沿
  73.                 {
  74.                         temp=TIM5CH1_CAPTURE_STA&0X3F;
  75.                         temp*=65536;//溢出时间总和
  76.                         temp+=TIM5CH1_CAPTURE_VAL;//得到总的高电平时间
  77.                         
  78.                         UltrasonicWave_Distance=(float)temp*170/10000;//距离计算公式：距离=高电平持续时间*声速/2   
  79.                                                                                                                   //即 距离= 高电平持续时间*340*100/（2*1000 000） = 高电平持续时间*170/10000
  80.                         //printf("Distance:%f cm\r\n",UltrasonicWave_Distance);//打印总的高点平时间
  81.                         TIM5CH1_CAPTURE_STA=0;//开启下一次捕获
  82.                 }
  83.                 LCD_ShowString(10,40,200,16,16,"TFTLCD TEST");
  84.                 LCD_ShowxNum(10,60,Sensor_Left,4,16,0);
  85.                 LCD_ShowxNum(10,80,Sensor_Middle,4,16,0);
  86.                 LCD_ShowxNum(10,100,Sensor_Right,4,16,0);
  87.                 LCD_ShowxNum(10,120,Turn,4,16,0);
  88.                 LCD_ShowxNum(10,140,Sensor,4,16,0);
  89.                 LCD_ShowxNum(10,160,UltrasonicWave_Distance,4,16,0);
  90.     Sensor_Left=Get_Adc(11);                //采集左边电感的数据
  91.                 Sensor_Right=Get_Adc(13);               //采集右边电感的数据
  92.                 Sensor_Middle=Get_Adc(12);              //采集中间电感的数据
  93.                 sum=Sensor_Left-Sensor_Right;  //归一化处理
  94.                 Sensor=150*sum/(Sensor_Left+Sensor_Middle+Sensor_Right+1);   //求偏差
  95.                 Sensor=Sensor>120?120:Sensor;
  96.                 Sensor=Sensor<-120?-120:Sensor;
  97.                 Get_RC();//pid计算输出
  98.                 if(UltrasonicWave_Distance>15)
  99.                 {
  100.                                 PWMA1=4000+Turn,PWMA2=0;        
  101.                                 PWMB1=0,PWMB2=3200+Turn;
  102.                 }
  103.                 else
  104.                 {
  105.                     PWMA1=7200+Turn,PWMA2=0;        
  106.                                 PWMB1=0,PWMB2=0+Turn;
  107.                 }
  108.                 //LED0=!LED0;
  109.                 //delay_ms(200);//测试主程序是否卡死
  110.         
  111.         }         
  112. }         
  113. u8  TIM5CH1_CAPTURE_STA=0;        //输入捕获状态                                                   
  114. u16        TIM5CH1_CAPTURE_VAL;        //输入捕获值

  116. //定时器5中断服务程序         
  117. void TIM5_IRQHandler(void)
  118. {

  120.          if((TIM5CH1_CAPTURE_STA&0X80)==0)//还未成功捕获        
  121.         {         
  122.                 if (TIM_GetITStatus(TIM5, TIM_IT_Update) != RESET)//检查TIM5更新中断发生与否
  123.                  
  124.                 {            
  125.                         if(TIM5CH1_CAPTURE_STA&0X40)//已经捕获到高电平了
  126.                         {
  127.                                 if((TIM5CH1_CAPTURE_STA&0X3F)==0X3F)//高电平太长了
  128.                                 {
  129.                                         TIM5CH1_CAPTURE_STA|=0X80;//标记成功捕获了一次
  130.                                         TIM5CH1_CAPTURE_VAL=0XFFFF;
  131.                                 }
  132.                                 else TIM5CH1_CAPTURE_STA++;
  133.                         }         
  134.                 }
  135.                 if (TIM_GetITStatus(TIM5, TIM_IT_CC1) != RESET)//捕获1发生捕获事件
  136.                 {        
  137.                         if(TIM5CH1_CAPTURE_STA&0X40)                //捕获到一个下降沿                 
  138.                         {                                 
  139.                                 TIM5CH1_CAPTURE_STA|=0X80;                //标记成功捕获到一次高电平脉宽
  140.                                 TIM5CH1_CAPTURE_VAL=TIM_GetCapture1(TIM5);
  141.                                    TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Rising); //CC1P=0 设置为上升沿捕获
  142.                         }
  143.                         else                                                                  //还未开始,第一次捕获上升沿
  144.                         {
  145.                                 TIM5CH1_CAPTURE_STA=0;                        //清空
  146.                                 TIM5CH1_CAPTURE_VAL=0;
  147.                                  TIM_SetCounter(TIM5,0);
  148.                                 TIM5CH1_CAPTURE_STA|=0X40;                //标记捕获到了上升沿
  149.                                    TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Falling);                //CC1P=1 设置为下降沿捕获
  150.                         }                    
  151.                 }                                                                                    
  152.          }

  154.     TIM_ClearITPendingBit(TIM5, TIM_IT_CC1|TIM_IT_Update); //清除中断标志位

  156. }

  158. //定时器3中断服务程序
  159. //void TIM5_IRQHandler(void)   //TIM3中断
  160. //{
  161. //        if (TIM_GetITStatus(TIM5, TIM_IT_Update) != RESET)  //检查TIM3更新中断发生与否
  162. //                {
  163. //                        
  164. //                        TIM_ClearITPendingBit(TIM5, TIM_IT_Update  );  //清除TIMx更新中断标志
  165. ////  if(Flag_Target==1)  '
  166. //                          
  167. //                                                                        
  168. //                        //LED1=!LED1;//测试中断
  169. //                        //         if(Flag_Target==0)
  170. ////         {
  171. //                                        //        Encoder_Left=Read_Encoder(2);                                       //===读取编码器的值                                                         //为了保证M法测速的时间基准，首先读取编码器数据
  172. //                                        //        Encoder_Right=-Read_Encoder(3);                                      //===读取编码器的值
  173. //                                                Get_RC();
  174. //                                                //Kinematic_Analysis(Velocity,Turn);                                                                                                                             //小车运动学分析   
  175. ////Motor_A=Incremental_PI_A(Encoder_Left,Target_A);                   //===速度闭环控制计算电机A最终PWM
  176. //                                //        Motor_B=Incremental_PI_B(Encoder_Right,Target_B);                  //===速度闭环控制计算电机B最终PWM
  177. //                                //                Xianfu_Pwm();                                                      //===PWM限幅
  178. //                                  //Set_Pwm(Motor_A,Motor_B,Servo);                                          //===赋值给PWM寄存器                  
  179. ////         }
  180. //                }
  181. //}
复制代码

所有资料51hei提供下载:
xunji5.16.7z (234.08 KB, 下载次数: 37)





欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1