毕业设计_基于stm32的智能小车设计(6)

2018-11-27 17:00

基于stm32的智能小车设计

TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; TIM_TimeBaseInit(TIM5, &TIM_TimeBaseStructure); ? 设置TIM5的输入比较参数,开启捕获模式。

TIM5_ICInitStructure.TIM_Channel=TIM_Channel_1;

TIM5_ICInitStructure.TIM_ICPolarity=TIM_ICPolarity_Rising; TIM5_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI; TIM5_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1; TIM5_ICInitStructure.TIM_ICFilter = 0x00;//IC1F=0000 TIM_ICInit(TIM5, &TIM5_ICInitStructure); ? 设置TIM5的DIER寄存器,使能捕获和更新中断功能。

TIM_ITConfig(TIM5,TIM_IT_Update|TIM_IT_CC1,ENABLE); ? 设置中断分组并编写中断服务函数

NVIC_InitStructure.NVIC_IRQChannel=TIM5_IRQn;

NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1; NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0; NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; NVIC_Init(&NVIC_InitStructure); ? 使能定时器

TIM_Cmd(TIM5,ENABLE );

我们知道了如何设置TIM5的CH1为输入捕获模式,我们是在TIM5的中断服务函数中采集持续时间t的,TIM5CH1_CAPTURE_STA为输入捕获状态,

TIM5CH1_CAPTURE_VAL为输入捕获值,中断服务函数如下所示: if((TIM5CH1_CAPTURE_STA&0X80)==0)//还未成功捕获

{ if (TIM_GetITStatus(TIM5, TIM_IT_Update) != RESET)

{ if(TIM5CH1_CAPTURE_STA&0X40)//已经捕获到高电平了

{ if((TIM5CH1_CAPTURE_STA&0X3F)==0X3F)//高电平太长了

{ TIM5CH1_CAPTURE_STA|=0X80;//标记成功捕获了一次

TIM5CH1_CAPTURE_VAL=0XFFFF;

}else TIM5CH1_CAPTURE_STA++;}}

if (TIM_GetITStatus(TIM5, TIM_IT_CC1) != RESET)//捕获1发生捕获事件

- 26 -

基于stm32的智能小车设计

{ if(TIM5CH1_CAPTURE_STA&0X40)

{ TIM5CH1_CAPTURE_STA|=0X80;

//捕获到一个下降沿

//标记成功捕获到一次上升沿

TIM5CH1_CAPTURE_VAL=TIM_GetCapture1(TIM5);

TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Rising); //CC1P=0 设

置为上升沿捕获

}else

//还未开始,第一次捕获上升沿

//清空

{ TIM5CH1_CAPTURE_STA=0;

TIM5CH1_CAPTURE_VAL=0; TIM_SetCounter(TIM5,0);

TIM5CH1_CAPTURE_STA|=0X40; //标记捕获到了上升沿

TIM_OC1PolarityConfig(TIM5,TIM_ICPolarity_Falling);

//CC1P=1 设置为下降沿捕获}}}

3、对采集的时间t进行处理,判断前方是否有障碍

我们对采集时间t的处理也是在TIM5的中断服务函数中的,我们根据因测量距离=(高电平持续时间t*340m/s)/2,得出只要高电平持续时间t<1500us,距离就小于25cm,就会判定前方有障碍,其详细代码如下:

if(t==2){Leftstate=temp;

- 27 -

if(TIM5CH1_CAPTURE_STA&0X80)//成功捕获到了一次上升沿

{

temp=TIM5CH1_CAPTURE_STA&0X3F; temp*=65536;//溢出时间总和

temp+=TIM5CH1_CAPTURE_VAL;//得到总的高电平时间 TIM_Cmd(TIM2, DISABLE); if(temp<1500)

{ stopward();t++;flag++; if(t==1)

{ Midstate=temp;

TIM_SetCompare2(TIM3,60);//舵机右转}

基于stm32的智能小车设计

}

TIM_SetCompare2(TIM3,250); //舵机左转

if(t==3) {t=0;

Rightstate=temp;

TIM_SetCompare2(TIM3,150);

rotate_Left();}} {

else

if(flag==0){farward_Low();} if(flag==1) {turn_Left();} if(flag==2) {turn_Right();} if(flag>=3)

{flag=0;rotate_Left();}

TIM_SetCompare2(TIM3,150);t=0;flag=0; } TIM_Cmd(TIM2, ENABLE);

TIM5CH1_CAPTURE_STA=0;//开启下一次捕获}}

2.4循迹模块设计

这节要完成的任务是使小车沿着黑带运动。要想使小车沿着黑带运动,必须使小车感应到黑迹在什么地方,然后让小车的中央处理单元驱动硬件电路完成相应的行为动作。循迹模块的设计就是使小车能准确的识别黑带的轨迹。小车的中央处理模块从循迹模块获得数据,然后中央处理模块根据采集的数据驱动电机模块完成相应的动作。考虑到成本和操作,本实验使用的红外探测器。 2.4.1 循迹模块结构及其原理

红外探测器(IR)是由红外发射管、红外接收管和部分电路组成。要做到4路循迹,需要使用4个独立的红外探测器器件。我们使用的IR5是一个集成模块,这个集成模块由5个红外探测器组成。其中中间的1个IR探测器在本实验中并未使用。红外循迹模块实物图如图2.27所示:

- 28 -

基于stm32的智能小车设计

图2.27 红外模块正反面

本实验使用的IR5集成模块是由5个相同的IR探测器电路组成的,所以我们只需要了解一个IR探测器的工作原理即可。我们知道IR探测器是由红外发射管、红外接收管和部分电路组成。基本原理是红外发射管发射红外光经地面反射,在黑色区域红外光被吸收,在非黑色区域红外光被反射,红外接收管根据反射光的强度为比较器提供模拟量,从而输出相应的电平量。其单个IR探测器电路原理图如图2.28所示:

图2.28 IR探测器电路原理图

根据原理图详解下IR探测器的工作原理:VCC为模块提供电源,是IR探测器工作的前提条件,红外发射管DF2发射红外光到达“地面”,经反射后红外光会到达DS2红外接收管,由于不同颜色的地面会对光的吸收有着不同的效果,所以发射后的光的强度也会不同,反射强度不同,LM339的5脚会输入一个变化的电压量,LM339是一个电压较器,当LM339的“+”端输入信号大于“-”端的比较信号后,LM339的输出端截止,在外部的上拉电源的作用下,使IR探测器的输出端输出+5v的电压。同理,在“+”端电压小于“—”端电压时,LM339输出端电压饱和使IR探测器输出为低电压。因此可以通过调节R2的电阻值,改变比较电压的大小即“—”端电压的大小,从而控制探测的距离。R4是整个正反馈电路的重要组成部分,由于“+”输入端电压会经常发生在比较电压附近扰动的现象,这些微小的扰动都会造成输出端的巨大变化,因此,我们采用正反馈的方式避免这种现象的发生。加入R4电阻,就成为人们所说的“施密特触发器”,其特

- 29 -

基于stm32的智能小车设计

性图如图2.29所示:

图2.29 施密特触发器特性图

当输入端的电压发生转化时,只要在比较电压值附近的干扰不超过du之值,输出的电压就不会改变。R4正反馈的引入,不仅提高了电路的处理速度,而且可以免除由于寄生电路耦合而产生的自己震荡。但是,在提升电路的处理速度的同时,带来的缺点就是分辨率降低,因为只要在du附近输出的电压值就不会改变。

2.4.2 循迹模块电路设计

IR5探测器的集成模块的电路原理图如图2.30所示:

图2.30 红外循迹模块电路图

2.4.3 红外循迹模块程序设计

根据电路原理图,我们对循迹子程序进行设计,循迹子程序流程图如图2.31所示:

- 30 -


毕业设计_基于stm32的智能小车设计(6).doc 将本文的Word文档下载到电脑 下载失败或者文档不完整,请联系客服人员解决!

下一篇:镇宣传工作存在的问题及整改措施

相关阅读
本类排行
× 注册会员免费下载(下载后可以自由复制和排版)

马上注册会员

注:下载文档有可能“只有目录或者内容不全”等情况,请下载之前注意辨别,如果您已付费且无法下载或内容有问题,请联系我们协助你处理。
微信: QQ: