收藏 分享(赏)

简易智能电动车设计.doc

上传人:微传9988 文档编号:2515645 上传时间:2018-09-20 格式:DOC 页数:32 大小:993.50KB
下载 相关 举报
简易智能电动车设计.doc_第1页
第1页 / 共32页
简易智能电动车设计.doc_第2页
第2页 / 共32页
简易智能电动车设计.doc_第3页
第3页 / 共32页
简易智能电动车设计.doc_第4页
第4页 / 共32页
简易智能电动车设计.doc_第5页
第5页 / 共32页
点击查看更多>>
资源描述

1、1 引言电动车的发展史比燃油汽车更长,世界上第一辆机动车就是电动车。后来,由于燃油汽车技术的迅速发展,而电动车在能源技术和行驶里程的研制上长期未能取得突破,从 20 世纪 20 年代初至 60 年代末,电动车的发展进入了一个沉寂期。进入70 年代以来,由于中东石油危机的爆发以及人类对自然环境的日益关注,电动车才再度成为技术发展的热点。近几十年来,主要工业化国家为电动车的开发投入了大量的人力和财力,电动车的各项相关技术也取得了重大的进展。尽管电动车在能源和行驶里程的研制方面,至今尚未取得突破性的进展,但是电动车的美好前景仍然激励着人们锲而不舍地开发新型电动车,改善其性能。处于世纪之交的今天,能源

2、和环境对人类的压力越来越大,要求尽快改善人类生存环境的呼声越来越高。为了适应这个发展趋势,世界各国的政府、学术界、工业界正在加大对电动车开发的投资力度,加快电动车的商品化步伐。虽然目前电动车在能源和行驶里程方面还未能尽如人意,但已足以满足人们的基本需要。从技术发展的角度来看,在走过了漫长而艰难的发展程之后,电动车正面临着重大的技术突破,有望成为 21 世纪的重要交通工具。在大都市中,电动车作为一种小型、中速和短途的日常交通工具,是十分理想的。电动车的开发关系到能源、环保、交通和高科技的发展以及新兴工业的兴起,它将推动整个国民经济的发展,成为新的经济增长点。电动车将使能源的利用多元化和高效化,达

3、到能量的可靠、均衡和无污染地利用。从环保的角度来看,电动车是无排放交通工具,即使计及发电厂所增加的排气,从总量上来看,它也将使空气污染大为减少。此外,电动车比传统的燃料汽车更易实现精确的控制,智能交通系统则有可能率先通过电动车来实现,从而提高道路利用率和交通安全性。现代电动车的能源系统、电机驱动系统、智能化的能量管理系统、充电系统、车载空调系统和变速系统,电动车的基础设施建设以及未来智能化的交通系统的发展。根据各类子系统的不同特点.近年来,各种显示高新技术的电动车层出不穷,日新月异。2 方案设计与论证2.1 设计要求(1)电动车从起跑线出发(车体不得超过起跑线) ,沿引导线到达 B 点。在“直

4、道区”铺设的白纸下沿引导线埋有 13 块宽度为 15cm、长度不等的薄铁片。电动车检测到薄铁片时需立即发出声光指示信息,并实时存储、显示在“直道区”检测到的薄铁片数目。(2)电动车到达 B 点以后进入“弯道区” ,沿圆弧引导线到达 C 点(也可脱离圆弧引导线到达 C 点) 。C 点下埋有边长为 15cm 的正方形薄铁片,要求电动车到达 C点检测到薄铁片后在 C 点处停车 5 秒,停车期间发出断续的声光信息。(3)电动车在光源的引导下,通过障碍区进入停车区并到达车库。电动车必须在两个障碍物之间通过且不得与其接触。(4)电动车完成上述任务后应立即停车,但全程行驶时间不能大于 90 秒,行驶时间达到

5、 90 秒时必须立即自动停车。2.2 小车本体小车行走机构的方案分析与选择: 方案一 履带式行走机构:运行平稳、可靠,走直线效果很好;但结构较复杂、移动速度较慢,转弯过程的控制性能较差。方案二 腿式行走机构:可以走出多种复杂的路线,但结构复杂、运动中的平衡性和稳定性差、移动速度较慢。方案三 两轮式行走机构:结构简单、运动平稳、移动速度快、转弯性能好,且易于控制,适用于小功率的行走驱动。方案四 四轮式行走机构:结构简单、运动平稳、移动速度快、易于控制,但原地转弯性能不够好。通过对小车要完成的任务的设计要求以及对四种方案的对比,我们最终选择了两轮式行走机构。车体框架,基于设计要,我们以对称结构为基

6、础设计。第 3 页 共 32 页2.3 主控单元2.3.1 硬件方案近年来,单片机应用技术发展迅速,为智能装置的开发设计带来了很大的便利。但 68HC 与 51 系列等传统的基于累加器结构的单片机,需要大量的程序代码,以实现累加器之间的数据传送,给汇编的程序开发增加了困难,也使高级语言开发中的编译效率难以提高。AVR 单片机采用 RISC 结构,具有 1MIPS/MHz 的高速运行处理能力;同时采用低功率,非挥发的 CMOSE 工艺制造,内部分别集成 Flash, EEPROM 和 SRAM 三种不同性能和用途的存储器。特别地,除了可以通过 SPI 口和一般的编程器对 AVR 单片机的Flas

7、h 程序存储器和 EEPROM 数据存储器进行编程外,还具有在线编程的特点,这给调试和使用带来了极大的方便。在 AVR 家族中,ATmega16 芯片内部集成了较大容量的存储器和丰富强大的硬件接口电路,具备 AVR 高档单片机 Mega 系列的全部优点,其价格于低档单片机相当,具有很高的性价比,较 AVR 的 AT90 系列相比,其 6 通道的 A/D 转换是 AT90 系列所不具备的。同时,Mega 系列的高可靠性完全保证了在小车系统中无需光电隔离的直接输出方式,故在小车的主控系统选用 ATmega16 单片机。2.3.2 软件单元汇编语言作为传统的嵌入式系统的编程语言,具有执行效率高的优点

8、,但其本身是低级语言,编程效率较低,可移植性和可读性差,维护极不方便。而 C 语言以其结构化,容易维护,容易移植的优势满足开发的需要。AVR 的 RISC 结构与 ICC AVR 开发平台保证了较高的编译效率,且有易于上手的特点,使我们能顺利的用 C 语言开发 AVR 系统。2.4 信息感知单元2.4.1 黑白区域检测单元要识别黑白区域可采用,光敏电阻、光敏二极管等对可见光敏感的器件,也可选用红外器件结合比较器输出高低电压的处理单元。但这两个方案都有受环境光影响较大的缺陷。在本设计中我们确定了基于 A/D 转换的反射式红外线感知单元,以检测黑线和跑道边线的位置。2.4.2 铁片检测单元方案一:

9、利用铁片的导磁作用即可检测位于磁块与霍尔式传感器之间的铁片。霍尔式传感器结构简单,频率响应宽,选用开关输出方式集成霍尔式器件可直接输出高低电平。 方案二: 电感式金属接近传感器。当外界的金属性导电物体到达感应区时,金属物体内产生涡流效应,导致 LC 震荡电路震荡减弱,振幅变小,这一震荡的变化,被后置电路放大处理并转换为一确定的输出信号达到检测的目的。根据需要,同时考虑题目的设计时间与开发工作量,我们采用成品的电感式金属接近传感器。2.4.3 寻光检测传感器引导光源的方向的检测有如下方案:方案一:在小车上固定的有指向的光敏检测单元,利用其输出信号的变化与小车的转角之间的关系来确定小车的方向。方案

10、二:在小车上安装扫射角度大于 300 度的指向的光敏检测单元,利用其输出信号随扫射角的变化关系,及寻光单元与小车之间的位置关系即可确定小车位姿与光源之间的相对关系。上述方案有快速性好,动态过程平稳的优点,被选用。2.4.4 光强检测光强检测为了使小车可靠停于车库,设计中增设了用 A/D 转换检测光敏电阻输出信号的光强检测单元。2.4.5 障碍检测检测障碍物,必须充分收集周围环境信息,对其分析,最后确定障碍物的位置信息。常用的检测手段有主动式和被动式。前者主动发射信号,再对的反射回的信号进行分析处理。被动式检测直接分析接受到的外部环境信号,要求系统自身信号处理能力较高。由于后者对检测对象的针对性

11、不强,我们选用主动式的检测方式。常用的检测信号有超声波、激光、红外线。从抗干扰性、检测精度、价格、使用性能等方面综合考虑,我们选用了红外线发射二极管和一体化接收头配对检测的方案。由于采用调制光技术及机遇统计分析的处理方式,所以在抗干扰性和稳定性方面有较高的技术指标。第 5 页 共 32 页2.4.6 小车行驶速度、距离及铁片长度检测利用对行走过程的脉冲进行计数即可测量小车速度、行驶距离,再配合铁片检测信号即可测量铁片长度。所以这里只需讨论对行走距离的检测方案。方案一:用测速发电机检测电机的转动角度,该方案对玩具电机这样的小驱动功率不适用。方案二:用增量式光电编码盘检测电机的转动角度,利用安装位

12、置与输出信号之间的对应关系检测电机的正反转。我们利用鼠标光电编码盘和光电对管改装成了转速检测单元。2.5 驱动单元2.5.1 电机的选择,驱动电路,电池的选择小车采用双电机分离驱动方式。永磁体直流电动机体积小,效率高,出力大,起动转矩大,过载能力强,动态特性好,控制方便。电机型选择时在体积,功率和转速基本条件满足的前提下主要还考虑伺服性能;综上几点要求我们选用了 151 型微型直流电机。小车寻线过程中要求被控电机能够调速和正反转控制,一般可以采用继电器和H 桥式驱动电路。本系统驱动单元选用的是电机驱动专用 H 桥驱动芯片 L298。选用国产镍氢电池,每节 1.2V 容量为 600mAh,5 节

13、串接而成,额定电压 6V,完全能够满足系统的需要。2.5.2 调速及正反转控制方案直流调速可以选用电压调速, 脉频调速(PFM),脉宽调速(PWM). 电压调速一般调试比较复杂,功率损失大,故不用此方案。脉频调速(PFM)一般用于大电机。而脉宽调速(PWM)简单可靠。PWM 输出脉冲信号经双 H 桥功率驱动电路 L298 后接至左右轮电机,控制小车运动。由于要达到比较高的控制要求,我们采用比例控制的闭环反馈电机调速。2.6 人机接口单元在人机接口单元我们选用了基于带锁存的移位寄存器的串行扫描方式的人机接口电路方案,较好地解决了口线占用,电路复杂度,使用功耗等问题。2.7 策略的选择题目对小车的

14、任务要求虽然比较简单,但还是有多种策略可以选择。不同的策略将导致不同的控制特性。根据题目的示意图及要求,我们可以将小车的运动分成 4 个阶段,每个阶段都可以选定不同的策略。第一阶段:从起跑点到 B 点,用寻线行走控制的方案,行进速度为 米/秒,以便于对铁片长度的准确测量;第二阶段:从 B 点到 C 点,用寻线行走控制的方案。这样,既能保证小车可靠到达 C 点,又能使小车到达 C 点后的方向能大致指向引导光源;第三阶段:自由避障,采用 控制方式。第四阶段:进入车库,采用 控制方式。策略一:行程如图 2.1。电动车出发后,在直道区沿引导线前进,边寻线,边检测金属块。在弯道区,沿引导线到达 C 点后

15、,检测金属块,发出声光信号,并停留五秒钟。调整前进方向,使之沿圆弧直径前进到 D,逆时针转 90 度,沿平行 AB 边前行到无障区的 E 点,调整方向进入车库。前进到 D, 顺时针转 90 度 行程 CD=0.64m前进到 E, 顺时针转 90 度 行程 DE=2.10m前进到 F, 逆时针转 90 度 行程 EF=0.15m前进到 D, 顺时针转 90 度 行程 CD=0.50m图 2.1 策略一示意图第 7 页 共 32 页图 2.2 策略二示意图 策略二:如图 2.2 ,小车在直道区及 C 点状况与策略一同。停留五秒钟后,小车调整前进方向,使之沿圆弧直径前进到 D1 心处。在圆心处搜索光

16、源,然后调整车前进方向,沿圆心与光源直线方向前进,直达车库。途中若遇障碍物,则首先避开障碍物,然后再搜索光源,从新确定前进方向,直到达到车库。前进到 , 顺时针转 , 行程 CD1=0.87 m1D10前进到 , 顺时针转 ,行程 =2.55 mF1FD前进到 G, 停下,行程 =0.2mG1策略比较:采用策略一时,通道宽,安全性好,因此在方案中采用。而策略二的通道窄,危险,如车体方位精确,可选用,一般不用此策略。3 理论设计3.1 小车本体设计3.1.1 二轮式行走机构的设计采用两个具有两个自由度的传统型车轮作为主动轮,并且采用双电机分别通过减速机构驱动左右轮,为保持车体平衡,在车的前后各有

17、一个支撑轮。这样布置小车可以实现零半径旋转、前后两个方向都可以运动、具有良好的启动和制动性能、使小车具有高度的灵活性。根据行驶路线以及场地的特点,两轮小车必须要解决如下的几个问题:1启动、制动和转动速度尽量快 。2能以很小的半径进行旋转。3良好的一致性,即:当小车的控制系统对车体左右轮发出相同的指令时,左右轮的转速应相同。二轮式行走机构包括:主动轮(驱动轮) 、支撑轮、减速器、车体框架、电动机等。3.1.2 两轮行走机构的动力学分析两轮车在转向时的运动如图所示。设左右轮的速度分别为: ,则小车的RLV、运动速度为: 2RL(3-1)-图 3.1 两轮车在转向时的运动如图小车的回转角速度为:(3

18、-BVRL2)其中,B 为小车的轮距。小车的运动速度在 X 、Y 坐标上的分量分别为:(3-sinVx3)(3-cosy4)由物理关系有:yxVdttwdt,第 9 页 共 32 页对(3-2) 、 (3-3) 、 (3-4)式取积分得:(3-twd05)(3-tatVX0sin6)(3-tdtY0cos7)其中 为小车的初试位置, 为小车的初始方位角。0YX、 0a由上面的分析可知,控制小车左右两驱动轮的速度,可使两轮的中心跟踪任何给定的轨迹。着也就是说明小车具有良好的转弯性能。主动轮采用的软质橡胶轮,使轮与纸面的摩擦增大,防止的小车的打滑,以避免速度与距离测量的误差。减速装置我们选用的是闭

19、式直齿圆柱齿轮减速器。其好处在于:齿轮传动精度较高、传动效率高、噪音小、结构简单、可靠性高,以及受外界干扰小等。3.1.3 驱动电机的选用:小车选用的 151 型微型直流电机3.2 小车主控系统设计小车控制系统的功能框图如图 3.2。LED, 蜂 鸣 器 , 数 码 管 屏 控 制 器 检 测 信 号 传 感 器 驱 动 电 路 电 动 机 行 驶 距 离 及 往 返 时 间 显 示 图 3.2 小 车 控 制 系 统 的 功 能 框 图 小车控制系统的电路原理框图如图 3.3。光 电 编 码 盘 LM339 LED显 示 Mega16L 光 电 寻 线 ( 反 射 式 红 外 传 感 器 )

20、 避 障 检 测 ( Mega8系 统 ) 金 属 探 测 ( 传 感 器 ) Ll298 行 走 电 机 左 右 6B595,7474HC595 光 敏 电 阻 ( 传 感 器 ) 寻 光 电 机 寻 光 驱 动 单 元 寻 光 雷 达 图 3.3 小 车 控 制 系 统 的 电 路 原 理 框 图 小车控制系统的电路原理图如图 3.4。图 3.4 小车控制系统的电路原理图3.2.1 显示及按键单元采用了键盘扫描和数码管显示单元作为人机接口。人机接口单元框图如图 3.5。第 11 页 共 32 页AVR 单 片 机 6B595 74HC595 数码管 段 选 位 选 键 盘 图 3.5 人

21、机 接 口 单 元 框 图 人机接口单元主要由数码管显示单元、键盘扫描单元和声音提示单元组成。该电路串行显示的数据由单片机的串行口输出,经串并转换电路 74HC595 将显示数据的段码动态地送到各数码管,各管的位选信号由 Mega16 经 6B595 送到各个数码管,实现串行动态显示。其具体电路如图 3.6。图 3.6 人机接口电路图3.2.2 声光报警单元在小车行进过程中,检测到铁片后需要送出声光信号。这里选用了直接由直流电源驱动的蜂鸣器做声音输出,发光二极管做光信号输出。图 3.7 声光报警电路图3.3 信息感知单元的设计3.3.1 黑白区域检测及寻迹单元在寻线时,我们只需要用三只反射式红

22、外传感器就可以实现小车沿曲线行走,如图 3.8 所示。当机器人偏离白线时,根据在白线上光电管的分布情况来调整机器人的行进姿态。我们一排装了 3 个光电管,上面是接收管下面是发射管,虚线表示黑线的两边沿,可见机器人正常行走时中间对管始终在白线上。图 3.9 是一个光电管的模拟光路图,它是反射式光电管,在距地面 23cm 的高度检测效果最佳。在电路设计中直接将光电管的输出信号送至 Mega16 的 A/D 输入端。图 3.8 寻 线 光 电 管 排 布 接 收 管 发 射 管 图 3.9 模 块 光 路 图 距 地 面 23cm 由于每个光电管的物理特性不一致,所以需要为每个光电管设置一个阀值电平

23、,采样时就要对每个光电管分别进行采样。首先,可以对黑色区域进行采样,然后采集白色区域的电平值。对于每一个光电管,可以取它们采集到的深色电平值和浅色电平值的平均值,作为该光电管的阀值电平。最后,每个光电管都得到了一个相应的阀值电平。这些阀值电平通过 A/D 转换器转换为数字量,将这些数字量保存到SRAM 或 EEPROM 中就完成了采样过程。在机器人寻线的实际过程中,将实时采集到的电平值经 A/D 转换得到的数字量,与已经存入在 SRAM 或 EEPROM 中的阀值进行比较,按照比较结果进行相应的处理。这样就可以实现一个自适应的处理。软件流程图如图 3.10。第 13 页 共 32 页初 始 化

24、 设 备 黑 色 色 值 采 样 白 色 色 值 采 样 阀 值 计 算 并 存 入 EEPROM 启 动 小 车 读 取 阀 值 到 数 组 A/D转 换 完 成 中 断 记 录 下 时 刻 接 收 的 色 值 与 阀 值 比 较 标 志 位 置 1 标 志 位 置 0 姿 态 调 整 并 结 合 位 置 反 馈对 小 车 进 行 控 制 小 于 阀 值 大 于 阀 值 图 3.10 寻 迹 软 件 流 程 图 3.3.2 反射式红外线障碍检测系统的硬件设计1组成该单元由发射部分、接收部分、单片机部分,报警部分四部分组成。发射部分:由 Mega8 内部计数器产生的 38KHZ 载波信号。接收

25、部分:采用红外化一体接收头 NB1838。它的中心频率为 37.9KHZ,抑制自然光的干扰。光电检测和前置放大器都集成在其中,最主要是它能解调出与它中心频率相符的信号。它的输出脚在没接收到载波信号是输出为高,当一旦接收到与其中心频率相符的信号时,输出就为低。其工作原理如图 3.11 所示:ABL 陷 波电 路 带 通 滤 波 器 整 形电 路 Output GND fo VS 图 3.11 红外一体化接收头结构图单片机部分:由时钟振荡器和 Mega8 嵌入式单片机组成,经过编程,单片机实现自动计数、计算时间 t,并判断是否有障碍物。报警部分:由发光管组成,主要功能是提示在规定的距离内是否有障碍

26、物。2工作原理此系统的工作原理电路图如 3.12 所示。其原理是:连续发出 10 组频率为1KHZ、占空比为 25%,载波频率为 38KHZ 的信号。当发射管发出占空比为 25%的高电平的调制信号时,红外一体化接收头经过解调,输出的也应该是频率为 1KHZ 占空比为 25%的低电平。但实际上红外一体化接收头内部电路要造成一部分信号延时,在发射头与接收头相隔很近的时候其输出的应该为 400ms 左右的低电平,而且这个低电平随着距离的增加会有所降低,甚至消失。本系统的避障机理就是发出 10 组此信号(见图 3.13) ,红外一体接收头再将解调后输出的 10 组信号的低电平时间用单片机的定时计数器存

27、储下来,求得其平均值(也就是所谓的概率事件,当然因为干扰和各方面的原因,即使在同一位置,接收到的低电平的值也会不一样,甚至因为外界的强烈红外光,有可能收到的信号会多于所发出的,不过这个应该算小概率事件,可以用软件进行排除、更正)后与事先给定的阀值进行比较,小于此阀值认为无障碍物;如果大于此阀值,就认为有障碍物。PD5 PD0 PD1 PD4( 使 能 端 口 ) Mega8 PD6 2803 5V 红 外 一 体 化 接 收 头 ( 1) 红 外 一 体 化 接 收 头 ( 2) 红 外 一 体 化 接 收 头 ( 3) 图 3.12 红 外 测 距 系 统 硬 件 电 路 图 第 15 页

28、共 32 页发 射 的 红 外 线 完 全 接 收 的 红 外 线 不 完 全 接 收 的 红 外 线 250us 400us 图 3.13 红 外 信 号 收 发 原 理 图 3.3.3 反射式红外线障碍检测系统的软件设计反射式红外线障碍检测系统的软件流程图如图 3.14。初 始 化 设 置 定 时 器 和 时 间 常 数 启 动 传 感 器 启 动 定 时 器 定 时 计 数 低 电 平 的 时 间 的 时 间 Y 停 止 计 时 计 算 时间 N 计 算 平 均 值 有 无 障 碍 物 策 略 Y 选 择 地 址 N 图 3.14 反 射 式 红 外 线 障 碍 检 测 软 件 流 程

29、图 判 断 是 否 为十 组 信 号 Y N 本系统的软件设计主要有几个重点,发 1KHZ 信号端口(PD5) ,地址选择端口(PD0 和 PD1) ,以及捕获中断端口(PD6) 。软件的主要工作原理是由 PD5 对 NE555输出占空比为 25%的高电平,频率为 1KHZ 的信号,再由 PD4 对数据选择器(SN74153)和译码器(74LS139)进行选通,PD0 和 PD1 作为地址选择端口,选择译码器的 Q0、Q1、Q2 端和数据选择器的 IC0、IC1、IC2 端,当判断有障碍物时,译码器的 Q3 被选中,并且发光二极管点亮。3.3.4 光传感器单元用于寻光的光传感器的光路示意图如图

30、 3.15 所示。+Vcc +Vout RL 光 敏 电 阻 小 孔 c 指 示 光 源 其寻光原理电路框图如下。Vcc 寻 光 电 动 机 A/D Mega8 I/O L298 M 图 3.16 寻 光 电 路 原 理 框 图 寻光软件基本流程图如 3.17。开 始 探 头 旋 转 寻 光 综 合 计 算 小 车 姿 态 信 息 小 车 姿 态 调 整 寻 到 了 ? 结 束 Y 图 3.17 寻 光 软 件 流 程 图 到 终 点 ? Y N N 图 3.15 光传感器的光路示意图第 17 页 共 32 页3.3.5 小车行驶速度、距离检测通常用编码器检测电机的速度。编码器又称“码盘” ,

31、是直接把位移变换为代码的数字式传感器。编码器有增量式和绝对式两种,按其结构划分,常用的有光电码盘和电磁式码盘。我们采用的是光电码盘。图 3.18 为增量式光电码盘及相位输出。它是一个旋转的脉冲发生器,根据脉冲数目或频率,可测出工作轴转角及转速。原理是在一圆盘上刻制节距和尺寸相等的透光小孔。圆盘与被测轴相连,当被测轴转动时,圆盘跟着一起转动,在圆盘的两侧,装有发光元件和感光元件。根据光线时断时续的变化(当光线透过小孔时感光元件就感受信号,反之,当光线被圆盘遮断时,信号即被截止)来检测旋转运动。脉冲的频率与圆盘的小孔数 N 及转速 n 有关,即为:Hzfc60(3-8) 其中,N 是固定的,故输出

32、脉冲频率 fc 与转速 n 成正比。为了判别方向,可以安装两对发光器和受光器。均对准透光孔,严格地相距半个透光孔宽度,这样安装使得码盘旋转时这两只受光器测得的信号 V1 和 V2 在相位上总是差 90 度(见图 3.18 ) 。若圆盘顺时针转动 V1 超前 V2,逆时针转动则 V2 超前 V1。该相位上的差别通过鉴相电路就能区别出旋转方向。测速传感器完成了电机转速向脉冲序列的转换,把测速传感器输出的脉冲接到计数单元进行计数,则将电机的转速转换成数字量。当采样周期确定之后,计数单元向单片机输出的数字量大小就反映了电机转速的快慢。本系统采用单片机的硬件定时机计数器,工作稳定。V1传感器 V2传感器

33、传感器 010110 10 1V1V21 0 0 1 101 1 1 00 1 0 0 10 1 0 1V1V2向上计数向下计数3.3.6 铁片检测铁片的检测用的是一体化电感式接近传感器。电感式接近觉传感器的工作原理是外界的金属性物体对传感器的高频振荡器产生非接触式感应作用。震荡器即是由缠绕在铁氧体磁芯上的线圈构成的 LC 震荡电路。震荡器通过传感器的感应面,在其前方产生一个高频交变的电磁场。当外界的金属性导电物体接近这一磁场,并到达感应区时,在金属物体内产生涡流效应,从而导致 LC 震荡电路震荡减弱,振幅变小,即称之为阻尼现象。这一震荡的变化,即被开关的后置电路放大处理并转换为一确定的输出信

34、号,触发开关并驱动控制器件,从而达到非接触式目标检测之目的。我们所选用的电感式铁片传感器的指标为:工作电压:5-30v; 检测距离:4mm: 工作方式:常开;安装尺寸;圆形 直径 12mm铁片位置及其长度的测量方法示意图如图 3.19。而铁片的位置参数 L 的计算公式为:(3-2)()(121SrSL9)小车距离及铁片位置、长度的测量软件流程为图 3.19。第 19 页 共 32 页开 始 记 录 行 驶 距 离 S1 检 测 到 信 号 ? Y 图 3.19 铁 片 位 置 测 定 软 件 流 程 图 检 测 信 号 停 止 ? Y N N 保 存 S1 声 光 信 息 显 示 保 存 距

35、离 S2 计 算 铁 片 距 离 保 存 数 据 结 束 3.4 电机驱动单元整个电机控制电路由上图所示的闭合环路构成,PWM 输出脉冲信号经双 H 桥功率驱动电路 L298 后接至左右轮电机,控制小车运动。在软件的速度控制单元中我们用了简单的闭环比例控制算法。L298 是双 H 桥高电压大电流集成电路。由图 3.20 可见,每个 H 桥的下侧桥臂晶体管发射极连在一起,其输出脚(SENSEA 和 SENSEB)用来连接电流检测电阻。Vss接逻辑控制的电源。Vs 为电机驱动电源。IN1-IN4 输入引脚为标准 TTL 逻辑电平信号,用来控制 H 桥的开与关即实现电机的正反转,ENA、ENB 引脚

36、则为使能控制端,用来输入 PWM 信号实现电机调速。4 特色与创新本设计在基于 Mega8 芯片并采用概率分析的避障单元的设计与实现、串行扫描方式实现的人机接口、寻光雷达及小车位姿控制等方面具有一定的特色与创新。4.1 串行扫描实现的人机接口串行工作方式使该功能模块的引线少,便于长线安装,有利于实际应用系统的结构设计。同时,该接口电路扩展方便,能以较高的性价比实现汉字显示、LCD 驱动等功能。与传统的动态显示方式和静态显示方式相比,该电路具有结构简洁、功能性强、成本低编程简单的特点,通过试运行,证明该电路设计是非常成功的。4.2 避障单元的设计在避障单元的设计中,判断有无障碍物时使用的是求平均

37、值,即求概率事件的值的方式。因为有外界德干扰和接收电路的延时,即使你发射出完全相同的十组信号,接收时也有所不同,基本上没有两组信号是完全相同,而且还有可能收到多于十组的信号(虽然这个是小概率事件) ,这时只能用软件进行排除和更正。先将所有低电平的时间计数下来,放入数据寄存器中。如果某些值太小或者太大就认为是无效值,再将有效的几组值求其平均值,再与阀值进行比较。运行试验也证明,本设计中采用的 Mega8 芯片基于概率分析的避障单元实现方式,取得很好的避障效果。图 3.20 L298 原理框图第 21 页 共 32 页4.3 寻光雷达及小车位姿控制由于从 C 点到车库一段,小车的运行失去了引导线的

38、作用,所以,设计中采用了 360 精位绕线电位器作为小车运行角度参数反馈器件,该器件的运行方式近似与雷达,我们给它取名为寻光雷达。将该寻光雷达检测得到的标志光信息送单片机,一方面控制小车下步运行姿态,另外也送出控制“雷达”跟踪光源的电机运行。这种方式较好地解决了小车脱离引导线之后的运行控制的问题。通过实验也得到同样的结论。5 调试过程及测试数据分析5.1 调试仪器仪表设计及测试中所用的仪器及工具主要有:测频率:HC-F1000微型数字频率计,用于记录车轮光电采样频率,进而计算行车距离。测时间:DM-1 型电子秒表,用于测量有关时间。测距离:313 型钢卷尺,用于测量行车距离和停车距离。仿真:E

39、200型仿真器,用于调试和修改软硬件。编程器:ICCAVR。电源:WYJ30-1A/3A 型稳压电源,干电池。用于研发期各路供电。常用仪表:MF-47 型模拟万用表、VC98 型数字万用表,用于电压、电流以及其它电子元器件的测量,数字万用表、TDS210 存储式示波器、AVR Studio。其它:PC 机,用于调试软件及整理文档。 5.2 调试数据及分析5.2.1 寻线表 5.1 光电管输出电压调试数据表左 中 右第 1 次 1.61V 1.71V 1.45V黑色第 2 次 1.65V 1.74V 1.48V白色 第 1 次 4.23V 4.35V 4.19V第 2 次 4.21V 4.31V

40、 4.15V5.2.2 脉冲1编码盘光电管输出电压表 5.2 光电管输出电压数据表 (Vcc=5V,发射管电流 10mA)KR27KR472第 1 次 第 2 次 第 1 次 第 2 次有阻挡0.91V 0.89V 1.65V 1.75V第 1 次 第 2 次 第 1 次 第 2 次无阻挡4.51V 4.50V 4.55V 4.60V经过实验测得 R2=27K 时,光电管的输出电压范围较大,所以可以采用。2波形v t vmin R2=27k v vmax 图 5.1 单 路 未 整 形 光 电 对 管 输 出 波 形 v 通过实验发现,输出波形幅值较小,所以需要外接整形电路。3脉冲数与行进距离

41、的校正整形后 A、B 路同步输出波形对比测试波形示意图如下:第 23 页 共 32 页V 图 5.2 整 形 后 A、 B路 同 步 输 出 波 形 对 比 图 由实验测得 A、B 两路光电对管输出信号具有较为准确的相位差,由此得出结论,可以可以采用判别编码盘来测量转动方向。5.2.3 避障一体化红外接收头输出波形如下:4.7V 0.3V 20ms 0.5ms 图 5.3 一 体 化 红 外 接 收 头 输 出 波 形 5.2.4 整体联调在直道区和弯道区,两方案是一样的,区别在障碍区到车库的过程和策略。因此测量分两部分来测量。下表为直道区和弯道区小车的相关运动参数测量。 分别为直道区中第一3

42、21,L块、第二块、第三块金属片到出发点的距离。表 5.3 小车的相关运动参数测量数据表A 到 C 的时间 B 到 C 的时间 在 C 停留时间 金属块距出发线的距离L1 L2 L3实际值 0.50m 1.20m 1.70m测量值 6s 5s 6s 0.51m 1.22 1.73m下表为方案一和方案二小车从障碍区到车库运动参数测量。每个参数测量了两次。表 5.4入 库 时 间 偏 差第 1 次 第 2 次方案一42s 39s方案二 35s 未进入6 部分程序清单6.1 测金属MAIN:MOVSP,60HMOV40H,#00HMOV41H,#00HMOV42H,#00HMOV43H,#00HMO

43、V60H,#00HACALL BCDACALL DISPMOV40H,50HCLRP3.7SS1:JB P3.7,SS1SETB P3.7SS2:JNB P3.7,SS2MOV40H,60HMOVA,40HADD A,#01HINC40HMOVA,40HDA AMOV40H,AMOV41H,#00HMOV42H,#00HMOV43H,#00HMOV60H,40HACALL BCDACALL DISPACALL DELAY1SCLR P3.7AJMP SS12006 级 本 科 毕 业 设 计 论 文 第 25 页 共 32 页DISP: MOV SCON,#00HMOV R0,#40HMOV

44、R2,#04HL00C9: MOV SBUF,R0L00CB: JNB TI,$CLR TIINC R0DJNZ R2,L00C9RET BCD: MOV R0,#40HMOV R2,#04HMOV DPTR,#TABLTAB: MOV A,R0MOVC A,A+DPTRMOV R0,AINC R0DJNZ R2,TABRETTABL: DB 0C0HDB 0F9HDB 0A4HDB 0B0HDB 99HDB 92HDB 82HDB 0F8HDB 80HDB 90H6.2 引导线测试MAIN:MOV P1,#0FFHACALL DELAY1SCLR P1.0CC1:JNB P3.5,CC2CL

45、R P1.2AJMP CC1CC2:JNB P3.4,CC3CLRP1.3AJMP CC2CC3:AJMP CC1DELAY1S:MOVR3,#50D1: MOV R4,#20D2:MOVR5,248DJNZ R5,$DJNZ R4,D2DJNZ R3,D1RET6.3 障碍物调试MAIN:MOV P1,#0FFHACALL DELAY1SSS:CLRP1.0NOPDD1:JNB P3.6,DD1SETB P1.0NOPNOPNOPNOPNOPNOPACALL DELAYCLRP1.1ACALL DELAY5SSETB P1.1CLRP1.0CLRP1.3ACALL DELAY5SACALL

46、DELAY5SACALL DELAY5SMOVP1,#0FFHAJMP SSDD3:JNB P3.6,DD3SETB P1.0NOPNOPNOPNOPNOPNOPCLRP1.1ACALL DELAY5SSETB P1.1CLRP1.2CLRP1.0ACALL DELAY5SMOVP1,#0FFHAJMP DD2DELAY1S:MOVR3,#50D1: MOV R4,#20D2:MOVR5,248DJNZ R5,$DJNZ R4,D2DJNZ R3,D1RET DELAY5S:MOVR3,#5D3: MOV R4,#20D4:MOVR5,248DJNZ R5,$DJNZ R4,D4DJNZ R3

47、,D3RET DELAY:NOPNOPNOPNOPNOPRETDD2:NOPNOPNOPNOPNOP2006 级 本 科 毕 业 设 计 论 文 第 27 页 共 32 页END6.4 传感器协调程序MAIN:MOVTMOD,#50HMOVTH1,#00HMOVTH0,#00HMOVP1,#0FFHACALL DELAY1SCLRP1.0AJMP LINEMOV40H,#00HMOV41H,#00HMOV42H,#00HMOV43H,#00HMOV50H,40HACALL BCDACALL DISPMOV40H,50HGO FORWARDSS1:JB P3.7,SS0ACALL MEATALA

48、JMP SS1SS0:JNB P3.3,SS2;LINEAJMP LINE;SS2SS2:JNB P3.5,SS3AJMP GUAIWANSS3:AJMP SS1MEATAL:DD1:JNB P3.7,DD1MOV40H,50HMOVA,40HADDA,#01HINC40HMOVA,40HDA AMOV40H,AMOV41H,#00HMOV42H,#00HMOV43H,#00HMOV50H,40HACALL BCDACALL DISPACALL DELAY1SMOV40H,50HAJMP SS1DISP: MOV SCON,#00HMOV R0,#40HMOV R2,#04HL00C9: MO

49、V SBUF,R0L00CB: JNB TI,$CLR TIINC R0DJNZ R2,L00C9RET BCD: MOV R0,#40HMOV R2,#04HMOV DPTR,#TABLTAB: MOV A,R0MOVC A,A+DPTRMOV R0,AINC R0DJNZ R2,TABRETTABL: DB 0C0HDB 0F9HDB 0A4HDB 0B0HDB 99HDB 92HDB 82HDB 0F8HDB 80HDB 90HLINE: SETB P1.1SETB P1.2SETB P1.3NOPCLRP1.0REJUD: JB P3.3,CONTRJB P3.5,GUAIWANAJMP REJUDCONTR:CLR P1.3ACALL DELAY9SJB P3.5,GUAIWANSETB P1.3NOPJB P3.5,GUAIWANNOPNOPJB P3.5,GUAIWANNOPNOPNOPCLRP1.2ACALL DELAY8SJB P3.5,G

展开阅读全文
相关资源
猜你喜欢
相关搜索
资源标签

当前位置:首页 > 学术论文 > 大学论文

本站链接:文库   一言   我酷   合作


客服QQ:2549714901微博号:道客多多官方知乎号:道客多多

经营许可证编号: 粤ICP备2021046453号世界地图

道客多多©版权所有2020-2025营业执照举报