版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、文档来源为:从网络收集整理.word版本可编辑.欢迎下载支持宁波大学创新性开放实验报告题目基于光电传感器的自动寻迹小车学 号:姓 名:专 业:指导教师:目录光电感应智能车 错误!未定义书签。一、硬件系统 错误!未定义书签。(一 )硬件框图 .31、电源模块42、寻迹模块3 、驱动模块454 、测速模块6二、软件系统7(一) 主程序流程图71、电机驱动82、舵机驱动10参考文献13光电感应自动寻迹智能车【摘要】 如果把自动寻迹小车成比例的扩大数倍,就成为真正有意义上的智能车, 可以运用于军事、民用领域,对未来汽车行业的发展有一定的借鉴意义。通过光电传感器 来寻找轨迹,以所编写的程序为软件支持,通
2、过单片机计算生成相应的控制参数,驱动电 机来使小车按照轨迹运动。其中小车在直线行驶过程控制参数保持不变,匀速行驶,而在 小车要转弯之前则要先减速以防止小车过弯时冲出赛道,弯道过去之后在加速行驶以减少 行驶时间。【关键词】 红外传感器 ; PID 控制;自动寻迹一、 硬件系统(一)智能小车的整体结构图 智能车通过单片机来接受和发出参数状态信号,电源模块是给智能车各个模块提供电压 以使模块可以正常运作, 寻迹模块则是包含着参数输送给单片机的作用, 驱动模块是小车动 起来的根源,测速模块是为了控制车速以使智能车平稳的沿着车道运行。1、电源模块在“飞思卡尔” 比赛中, 比赛方提供的是智能车竞赛统一配发
3、的标准车模用 7.2V 供电, 但是在单片机系统、路径识别的光电传感器、光电码编码器等均需要 5V 电源,直流电机可 以使用 7.2V 蓄电池直接供电, 我们采用的电源有串联型线性稳压电源 ( LM2940、7805 等) 和开关型稳压电源(LM2596)两大类。对于单片机,选用LM2940-5单独对其进行供电;而其它模块则需要通过较大的电流,利用LM2940-5和LM2596-5对控制系统和执行部分开供电,可以有效地防止各器件之间发生干扰,以及电流不足的问题,使得系统能够稳定地工作。电源电路图:2、寻迹模块寻迹模块是智能车系统的关键模块之一, 所寻找的路径的好坏, 将直接影响竞赛的结果, 我
4、们采用的是光电传感器来寻找路径, 光电传感器具有电路简单、 信号处理速度快等特点。 因为在赛道中由黑色轨迹线和大面积的白色区域组成,则会使发光二极管发射的光线强度 不同,从而使接受到的光线强度不同,以此来指示小车前进。红外传感器电路图:3、驱动模块电机驱动电路可以用 MOS管搭建H桥驱动电路。采用 MOSt构成的H桥电路,控制直 流电机紧急制动。用单片机控制MOST使之工作在占空比可调的开关状态,精确调整电动机转速。这种电路由于 MOS管工作在饱和截止状态, 而且还可以选择内阻很小的 MOS管,所以效率可以非常高,并且 H桥电路可以快速实现转速和方向控制。MOST开关速度高,所以非常适合采用P
5、WM调制技术。所以我们选择了用MOST搭建H桥驱动电路。电机正转电路:电机驱动电路:4、测速模块在比赛中常用霍尔传感器来测速。如图1所示,在半导体薄片两端通以控制电流I ,并在薄片的垂直方向施加磁感应强度为B的匀强磁场,则在垂直于电流和磁场的方向上,将产生电势差为UH的霍尔电压,它们之间的关系为 U=k,d为薄片厚度,k为霍尔系数,通过对一定时间内脉冲信号数量的捕捉可以计算出车轮的速度。霍尔传感器的电路图:软件系统系统主程序流程图开始1、电机驱动系统初始化驱动电机工作5文档来源为:从网络收集整理.word版本可编辑.因为智能车在赛道上的路径不是一条直线,它是存在弯道的,所以让小车以个加速度均匀
6、的行驶是难以实现的,在此,定时器开用在弯道里速度慢一些以保证稳定性,在直道上速度快一些以减少整体行驶时间。在软算方法采用PID控制。PID控制器算法:u(t)=kpe(t)+1/TI在实验中为提高精确度可避免大的超调,又使PD算法,即当速度误差较大时选择 舵机工作系统有较快的相应,当速度误差较小时选择,选择积分分离PD控制,制精度。u(k)=kpe(k)+bT i 刀 e (j )-e(k-1)b=1PID控制,可保证控e (k)是当前给定速度和测量速度的偏中断否e (応PID控制程序:#in clude速度采样勺卜是上次的偏差。#in cludeglobal_varible.h简单易懂,使用
7、中不需精确的系统模型是我工作择的原因。/ e(t)dt+TD*de (t)/dtvoid PID_Math(void)文档来源为 :从网络收集整理 .word 版本可编辑 .欢迎下载支持偏差一阶偏差二阶积分输出/ 温度控制设定值 37.00 度/ 本次偏差计算一阶偏差计算二阶偏差/ 一阶偏差的限制范围/ 偏差之和/ 积分最多累计的温差/ 计算 PID 比例和微分输出/ 如果温度相差小于 1.5 度则计入 PID/ 如果温度相差大于 1 度时积分累计限signed long ee1;/signed long ee2;/signed long d_out; / if(!Flag_PID_T_OK)
8、return;Flag_PID_T_OK=0;Temp_Set=3700;PID_e0 = Temp_Set-Temp_Now;ee1 = PID_e0-PID_e1;/ee2 = PID_e0-2*PID_e1+PID_e2;/if(ee1 500)ee1 = 500;if(ee1 200)PID_e_SUM = 200;if(PID_e_SUM -200)PID_e_SUM = -200;PID_Out = PID_kp*PID_e0+PID_kd*ee1; if(abs(PID_e0) 100)制if(PID_e_SUM 100) PID_e_SUM = 100;PID_Out/=100
9、;/ 恢复被 PID_Out 系数放大的倍数if(PID_Out 200)PID_Out=200;if(PID_Out 300)/ 当前温度比设定温度低 3 度则全速加热八、PID_Out=200;if(PID_e0 -20)/ 当前温度高于设定温度 0.2 度则关闭if(PID_e_SUM -100) PID_e_SUM = -100;d_out = PID_ki*PID_e_SUM;if(PID_e0 150)PID_e_SUM = 150;if(PID_e_SUM 0)积分正输出d_out = 1;PID_Out += d_out;elsePID_e_SUM=0;/ 积分输出/ 当前温度
10、高于设定温度 0.5 度时积分/ 当前温度高于设定温度 0.5 度时削弱/PID 比例, 积分和微分输出加热9文档来源为 :从网络收集整理 .word 版本可编辑 .PID_Out=0;Hot_T_Run=PID_Out;/ 加热时间控制输出PID_e2 = PID_e1;/保存上次偏差PID_e1 = PID_e0;/保存当前偏差1、舵机驱动原理:控制电路板接受来自信号线的控制信号,控制电机转动,电机带动一系 列齿轮组,减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的,舵 盘转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板, 进行反馈,然后控制电路板根据所在位置
11、决定电机的转动方向和速度,从而达到目 标停止。即由pwm波产生模块计算相应的pwm波占空比,产生 pwm波,驱动舵机,改变舵机前轮转角意识智能车转弯。程序:#include #define uchar unsigned char#define uint unsigned intuinta,b,c,d;/*a 、b 为舵机 1、2 的脉冲宽度 /* /*c、d 为中间变量 /*sbitp12=P1A2;sbit 卩13=卩1人3;sbit p37=P3A7;/* 输出管脚void timer0(void) interrupt 1 using 1p12=!p12;/* 输出取反 */c=20000-c;/*20000 /* 一个周期时间 20msTH0=-(c/256);TL0=-(c%256); /* 重新定义初值if(c=500&c=500&d=2500)d=b;else d=20000-b;void mai n(void)TMOD=Ox11; /* 设初值p12=1;p13=1;a=1500;b=1500;/* 舵机90度的位置c=a;d
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 2024个人珠宝买卖合同范本
- 2024年度版权质押合同:含版权内容、质押价值、质权实现
- 旅游推广合作合同实例
- 摄影棚居间服务合同样本
- 房屋销售合同模板手册
- 乐团合作合同范本大全
- 电子邮件服务租用协议
- 2024家教公司与兼职教师合作合同范本
- 企业房屋租赁合同范本
- 2024保密合同样书范文
- 四川省食品生产企业食品安全员理论考试题库(含答案)
- 机织服装生产中的质量控制体系建设考核试卷
- 病理学实验2024(临床 口腔)学习通超星期末考试答案章节答案2024年
- 2024年广西安全员C证考试题库及答案
- 期末测试卷(试题)-2024-2025学年人教PEP版(2024)英语三年级上册
- 2024至2030年中国手机配件产业需求预测及发展趋势前瞻报告
- 2024年小学闽教版全册英语词汇表
- 课题开题汇报(省级课题)
- 清真食品安全管理制度
- 学校心理健康教育合作协议书
- 2024江苏省沿海开发集团限公司招聘23人(高频重点提升专题训练)共500题附带答案详解
评论
0/150
提交评论