首 页文档资料下载资料维修视频包年699元
请登录  |  免费注册
当前位置:精通维修下载 > 文档资料 > 家电技术 > 单元电路介绍 > 其它电路
基于MC9S12DGl28单片机的智能寻迹车设计
来源:本站整理  作者:佚名  2009-04-23 10:20:15



2.6 加速度检测模块
    智能车在高速行驶中如果突然转向,会出现侧滑现象。该系统设计采用ADXL202加速度传感器判断移动智能小车在行驶中是否出现侧滑现象。ADXL202是美国ADI公司推出的低成本双轴加速度传感器,其外围电路简单.采用5 V供电,将加速度传感器的输出端9引脚和10引脚直接接到单片机的AN00,AN01引脚,通过计算输出信号的占空比可
精确检测轴向和横向加速度。
2.7 转向控制模块
   
智能车使用韩国futaba公司的S3010舵机完成转向控制。舵机控制信号由单片机的PWM模块PWM0和PWMl联合产生一个16位的PWM信号。由于舵机的转角与脉冲宽度存在线性关系,改变PWM占空比可改变输出脉冲的宽度。从而控制舵机转向。将驱动舵机脉冲波型的周期从原来的20ms减小到10 ms,增加舵机控制信号的更新频率,减少舵机控制环节中的延时,提高整个车模转向控制速度。

3 系统软件设计
   
系统的基本控制策略是根据CCD传感器检测到的路径信息,车速检测模块检测到的当前车速信息和加速度传感器检测到的加速度信息,来控制舵机和直流驱动电机运动。
3.1 车速控制
   
为了提高机器人运行的稳定性,采用PID算法实现直流电机的转速闭环调节,PID控制器的输入量为给定转速与输出转速的差值,采用增量式PID算法。
3.2 智能车平稳性控制
   
为了避免智能车发生侧滑现象,应在智能车上安装加速度传感器,以检测是否发生侧滑。车速为v,转向角为δ,车体质量为m,轴距为l,当理想转向时,向心加速度为a,则a=mv2tanδ/l。当加速度传感器反馈回的实际加速度a*小于理论加速度a时(实际中应当保持一定的死区),表明智能车系统存在侧滑现象。这时便命令智能移动小车减速,速度参考量为
3.3 舵机转向控制
   
系统使用模糊控制算法控制智能车转向。传感器检测的重点是转向角误差,当转向角误差相同时,不同的误差变化率反映不同的轨道半径,因此,该设计还检测转向角误差变化率。当误差量很小,且误差变化率不变时,则判定为智能小车正沿着引导线行驶,则机器人小车沿直线行进;若误差变化率较大时,表明智能小车正在偏离引导线,此时,需对航向角做相应调整。通过CCD图像传感器检测白色地面上的黑线,根据返回的信号得出驾驶角误差和误差变化率,将CCD图像传感器视觉中心的误差和误差变化率作为控制器的输入,分别用e和ec表示;输出为驾驶角,用δ表示。模糊语言值分别选为:e:{LB,LM,LS,CE,RS,RM,RB};ec:{PB,PM,PS,Z0,NS,NM,NB};δ:{LB,LM,LS,CE,RS,RM,RB}。隶属度函数采用三角形,如图4所示。交叠系数β=(c1一a2)/(c2-b1),取0.75。根据驾驶经验建立规则库进行模糊推理后.利用重心法进行反模糊化得出舵机所要转的角度。

3.4 智能车控制流程
   
设计中,程序初始化完成后便进入空闲模式,等待中断发生。中断包括车轮转速计数器中断、CCD图像捕捉中断和以10 ms为周期的定时器0中断。驱动电机和舵机的PWM控制信号由单片机的PWM模块自动产生,其定时器0的中断服务程序如图5所示。

4 结语
   
以MC9S12DGl28作为控制核心,设计自主寻迹的智能车控制系统,在检测到智能车运动信息和道路信息的基础上,采用模糊控制算法控制舵机转向,通过转速PID调节的方式控制直流电机。实验证明:该智能车在白色的跑道上能沿着一定宽度任意弧度的黑色引导线以较快的速度平稳地行驶,寻迹效果良好,速度和转向控制响应快,系统的稳定性和抗干扰能力强,速度可以达到1.5 m/s,此方案已应用于全国智能车大赛。

上一页  [1] [2] 

关键词:

文章评论评论内容只代表网友观点,与本站立场无关!

   评论摘要(共 0 条,得分 0 分,平均 0 分)

推荐阅读

图文阅读

热门阅读

Copyright © 2007-2017 down.gzweix.Com. All Rights Reserved .
页面执行时间:208,769.50000 毫秒