1、上 海 电 力 学 院 DSP原理与应用课程设计论文 设计名称 基于 DSP2407的自动避障小车系统设计 院 （系） 专 业 班 级 学生姓名 学 号 指导老师 目录 摘要 .3 小车避障系统设计的意义 .3 设计功能概述 .4 硬件选择 .4 电机驱动模块 .6 传感器系统 .7 壁障模块 .8 电源电路的选型 .9 整体构思 .9 避障电路 .10 电机驱动电路 .11 避障小车设计 .12 1、 自动避障小车总体设计 .12 2、 自动避障小车的硬件设计 .12 3、 自动避障小车的软件设计 .16 4、 结论 .18 参考文献 .19 基于 DSP2407的自动避障小车系统设计 摘要
2、 随着电子技术的发展、数字信号处理器 (DSP)的广泛应用和传感技术的突破性发展，基于 DSP 实现的控制技术已被许多系统所采用。由于 DSP 器件具有较高的集成度，具有比单片机更快的 CPU，更大容量的存储器，内置有波特率发生器和 fifo 缓冲器，提供高速同步串口和标准异步串口，最为突出的是， DSP 器件精简的指令系统 (大多数指令能在一个指令周期内完成 )、独立的程序和数据空间等使其具有高速的数据运算能力，使设计出结构简单性能优越的矢量控制调速系统成为可能，因此 DSP 越来越多地被应用于电机控制中。 小车避障系统设计的意义 自第一台工业机器人诞生以来， 机器人的 发展 已经遍及机械、
3、电子、冶金、交通、宇航、国防等领域。近年来机器人的智能水平不断提高 ， 并且迅速地改变着人们的生活方式。 人们 在 不断探讨 、 改造 、 认识自然 的 过程中 ，制造能替代人劳动的机器一直是人类的梦想 。 随着 科 学 技 术的 发展 ，机器人的感觉传感器种类越来越多，其中视觉传感器成为自动行走和驾驶的重要部件。视觉的典型应用领域为自主式智能导航系统，对于视觉的各种技术而言图像处理技术已相当发达，而基于图像的理解技术还很落后，机器视觉需要通过大量的运算也只能识别一些结构化环境简单的目标。视觉传感器的核心器件是摄像管或 CCD， 目前的 CCD 已能做到自动聚焦。但 CCD 传感器的价格、体积
4、和使用方式上并不占优势，因此在不要求清晰图像只需要粗略感觉的系统中考虑使用接近觉传感器是一种实用有效的方法。 机器人 要实现自动导引功能和避障功能就必须要感知导引线和障碍物 ，感知导引线相 当 给 机器人 一个视觉功能 。避障控制系统是基于自动导引小车（ AVGauto-guide vehicle）系统，基于它的智能小车实现自动识别路线，判断并自动避开障碍，选择正确的行进路线。使用传感器感知路线和障碍并作出判断和相应的执行动作。 随着生产自动化的发展需要，机 器人已经越来越广泛地应用到生产自动化上，随着科学技术的发展，机器人的传感器种类也越来越多，其中红外传感器已经成为自动行走和驾驶的重要部件
5、。 避障 小车是一种移动机器人，它通过 传感器系统感知外界环境，在复杂环境中自主移动并完成避障，一般采用超声波、红外、激光、 CCD 等 传感器 设计。由于红外 传感器 探测视角小。方向性强，测量精度高，价格便宜，而且可在夜间工作，因此红外 传感器 作为视觉应用于移动机器人避障。本次设计是以 TI 公司生产的 TMS320LF2407型 DSP 为核心，采集环境信息并控制智能小车， 3个红外发收 传感器 检测智能小车前方的障碍物，并且根据障碍物位置进行自动避障。 红外的典型应用领域为自主式智能导航系统，机器人要实现自动避障功能就必须要感知障碍物，感知障碍物相当给机器人一个视觉功能。智能避障是基
6、于红外传感系统，采用红外传感器实现前方障碍物检测 ，并判断障碍物远近。 设计功能概述 功能概述 智能小车采用前轮驱动，前轮左右两边各用一个电机驱动，分别控制两个轮子的转动从而达到转向的目的，后轮是万向轮，起支撑的作用。将三个红外线光电传感器分别装在车体的左中右，当车的左边的传感器检测到障碍物时，主控芯片控制右轮电机停止左轮转动，车向右方转向，当车的右边传感器检测到障碍物时，主控芯片控制左轮电机停止转动，车向左方转向，当前面有障碍物时规定车右转。于此同时测定速度并显示，在避障小车前进的同时从 LCD 点阵液晶显示器上显示小车当时速度。在小车左转或右转时在 显示器上显示出左或右。 硬件选择 TMS
7、320LF2407 芯片简介 TMS320LF240x 系列简介 TMS320LF240x 系列是 TMS320C2000 家族中最新、功能强大的 DSP 芯片，其中 LF2407 是最具有革命性的产品，是当今世界上集成度较高、性能较强的运动控制芯片，特别适合于三相异步电动机的高性能控制。它与现存 240x DSP 控制器芯片代码兼容的同时， 240x 芯片具有处理性能更好 (30mips)、外设集成度更高、程序存储器更大、 A/D 转换速度更快等优点，是电机数字化控制的升级产品。 TMS320LF2407(简称 2407)是 TI 公司专门为工业控制领域量身定做的一款高性能、低功耗、高性价比
8、的 16 位定点 DSP 芯片。 2407 继承了 TMS320F240x 系列芯片在数字电机控制 (DMC)方面的优势，同时还提供相当丰富的外设资源，是一款相当不错的芯片，为工业系统的控制器设计提供了一个很好的解决方案。 2407芯片是一款 16 位定点 DSP 芯片。它是 TI 的 TMS320LF240x 系列芯片的超集，时钟达到 30MHz(TMS320LF2407A 为 40 MHz)，片内资源包括： 2.5K RAM、 32K Flash、BOOT ROM、 16 路 10 位 A D 转换器、 2 个事件管理器 (包括 16 个 16位 PWM 模块、4个 16 位通用定时器、
9、6个捕获单元等 )、外部存储器接口、看门狗模块、 SCl/SPI接口、 CAN 控制器、 PLL 电路、 40 个通用 I 0口、 5个外部中断口，符合 1EEEll49 1规范的 JTAG 接口 (便于仿真调试和最终程序下载 )。 TMS320LF240x 系列主要特点 (1)两个事件管理器模块 eva 和 evb，为开发者提供完整的、高效的马达控 制方案，提供所有的 pwm 和 io，可以控制所有类型 的电机。 (2) 采用高性能静态 cmos 技术，使得供电电压降为 3.3v，减少了控制器的 损耗； 30mips 的执行速度使得指令周期缩短到 33ns，从而提高了控制器的 实时控制能力。
10、 (3) 片内有高达 32k 16 位的 flash 程序存储器；高达 2.5k 字 16 位的数 据 /程序 ram； 544 字节双端口 ram(daram)； 2k字的单口 ram(saram)。 (4) 可扩展的外部存储器总共具有 192k 16 位的空间，分别为 64k 字程序 存储器空间、 64k 字的数据存储空间和 64k 字的 i/o 空间。 (5) 10 位 ADC 转换器，其特性为：最小转换时间为 500ns、 8个或 16个多 路复用的输入通道，采集时间和转换时间分开，提高了采样率和输入阻抗， 并且支持自动顺序采样，不需 CPU 干预。 (6) CAN 总线控制器可以为控
11、制器、传感器、激励源以及其它节点提供良好 的通讯，特别适用于工业现场和汽车等强噪声和恶劣的环境中。 (7) 5 个外部中断 (两个驱动保护、复位和两个可屏蔽中断 )。 本次课程设计采用 TI 公司的 DSP 芯片： TMS320LF2407。 TMS320LF2407芯片图如下： 图 1 TMS320LF2407 智能小车 智能小车可通过简单的 I 0 控制实现小车的前进、后退、左转和右转等功能。智能小车分为车体和控制板两部分，控制板将来自 DSP 芯片 I/O 口引脚的控制信号转换为电机的驱动信号以驱动电机使车轮运转，小车的驱动和转向由左右两轮驱动实现，左右轮的驱动电路是全桥驱动电路，双电机
12、四轮驱动。小车的工作电压为直流 4-6V，车速是 0.6m s 电机驱动模块 方案一：采用继电器对电动机的开或关进行控制 ,通过开关的切换对小车的速度 进行调整。此方案的优点是电路较为简单 ,缺点是继电器的响应时间慢 ,易损坏 ,寿命较短 ,可靠性不高。 方案二：采用电阻网络或数字电位器调节电动机的分压，从而达到分压的目的。但电阻网络只能实现有级调速，而数字电阻的元器件价格比较昂贵。更主要的问题在于一般的电动机电阻很小，但电流很大，分压不仅会降低效率，而且实现很困难。 方案三：使用功率三极管作为功率放大器的输出控制直流电机。线性型驱动的电路结构和原理简单，成本低，加速能力强，采用由达林顿管组成
13、的 H型 PWM电路。用单片机控制达林顿管使之工作在占空比可调的开关状态下， 精确调整电动机转速。这种电路由于工作在管子的饱和截止模式下，效率非常高； H 型保证了简单的实现转速和方向的控制；电子管的开关速度很快，稳定性也极强，是一种广泛采用的 PWM 调速技术。 这种调速方式有调速特性优良、调整平滑、调速范围广、过载能力大，能承受频繁的负载冲击，还可以实现频繁的无级快速启动、制动和反转等优点。因此决定采用使用功率三极管作为功率放大器的输出控制直流电机。 传感器系统 方案一：反射式红外发射 接收装置，只有物体反射红外光时才有信号输入，其信号强度与小车距障碍物的距离成正比。因此可利用信号强度作
14、为避障依据。 红外探测器的选型与工作方式 : 1、红外探测器的选型 红外探测器以其发射功率大、抗干扰能力强而在工业生产中有着广泛的应用，红外探测器按其工作模式可大致分为主动式与被动式，主动式红外探测器自带红外光源，通过对光源的遮挡、反射、折射等光学手段可以完成对被探测物体位置的判别。被动式红外探测器本身没有光源，通过接受被探测物体的特征光谱辐射来测量被探测物的位置、温度或进行红外成像。 直流直接驱动方式装置简单但检测距离和抗干扰能力都比较差；交流调制方式由于可以采用交流耦合方式解决了放大器的直流漂移问题从而可以 大大提高检测的距离，同时由于环境光产生的干扰多数情况是信号的直流或低频分量可以由滤
15、波器加以隔绝，因此交流调试方式抗干扰能力也比较强，缺点是系统相对复杂。 在本课程设计中 要利用红外探测器检测障碍物的距离，显然选用主动式红外传感器比较合适，系统的造价可以降低可靠性可以提高。 主动式红外传感器又可分为分立元件型、透射遮挡型和反射型（如图 2 示），分立元件型发光管与接收管相互独立，用户在使用时可以根据需要灵活的设定发光管与接受管的位置，并可利用棱镜、透镜等完成特殊的目的，缺点是装置麻烦。透射遮挡型和反射型通过塑料模具将 发光管与接收管封装在一起，非常方便用户使用，在本题中对障碍物的检测我使用反射型。 2、主动式红外探测器的工作方式选取 主动式红外探测器常用的驱动方式可分为直流直
16、接驱动方式和交流调制方式，直流直接驱动方式装置简单但检测距离和抗干扰能力都比较差；交流调制方式由于可以采用交流耦合方式解决了放大器的直流漂移问题从而可以大大提高检测的距离，同时由于环境光产生的干扰多数情况是信号的直流或低频分量可以由滤波器加以隔绝，因此交流调试方式抗干扰能力也比较强，缺点是系统相对复杂。 方案二：采用反射式超声波换能器，只有 物体反射超声波时才有信号输入，测量发射接收信号间的时间差 T2-T1，利用其可以得到障碍物的距离，将该信息送给单片机，单片机发出控制信号改变小车的转向，使小车不与障碍物发生接触。该方法适合较远距离障碍物检测。 反射式超声波换能器成本高，电路设计复杂，因为不
17、要求检测的很远，于是选自了反射式光电传感器， 在课题中对前方障碍物的检测因为要求检测距离较远，受到环境光的干扰比较大，因此我们选用抗干扰能力较强的交流调制工作方式；而对小车侧面障碍物的检测由于要求检测距离较近，外界干扰相对较弱，为简化设计我们选用直流直接驱动方 式。 壁障模块 在壁障模块中，可以选择超声波壁障。其优点是反应速度灵敏，距离远，受外界干扰小。但是，如果利用超声波传感器进行壁障的话，由于空间小声波在小空间不同方向里会进行多次反射，左右前后的传感器之间相互干扰，使控制中心不能明确判断出那个方位遇到了障碍物，从而动作紊乱，不能实现要求。使用红外接收头和发射管配合，利用 38k 频率解决灵
18、敏度问题。 38K 调制和发射电路。使用一个定时器的快速 PWM 模式产生 38K 调制信号，通过剩余的四个施密特触发器（有 2个已经用在光电编码部分）缓冲，推动 8050 三极管和红外发 光管来发射已经调制的红外线。其中 2个 1N4148 接 IO 脚，控制左右红外发光管轮流发射。后面串接的可见光 LED 是为了方便用户调试而设臵的，让用户知道当前是否在发射红外线。通过调节 PWM 的占空比，调节红外发光管的亮度，从而实现调节感知红外发光管 红外接收管 分立元件型 透射遮挡型 反射型 图 2 红外探测器的形式 障碍物距离的功能。利用红外传感器，其优点是对近距离的障碍物反应速度灵敏，不同方位
19、的传感器之间信号不会相互干扰，造成误动作。缺点是距离近，易受到自然光的干扰。经过两种传感器性能对比与题目要求的综合考虑分析，最终选择红外传感器作为小车的眼睛，进行壁障。 电源电路的选型 方案一：所有器件 采用单一电源（ 6节 AA 电池）。这样供电比较简单；但是由于电动机启动瞬间电流很大，而且 PWM 驱动的电动机电流波动较大，会造成电压不稳、有毛刺等干扰，严重时可能造成单片机系统掉电，缺点十分明显。 图 3 稳压电路 方案二：双电源供电。将电动机驱动电源与单片机及其周边电路电源完全隔离，利用光电耦合器传输信号。这样做法虽然不如单电源方便灵活，但可将电动机驱动所造成的干扰完全消除，进一步提高系
20、统稳定性。 整体构思 经过方案论证的过程之后，我选定了仅采用 LF2407 作为核心部件的方案，其系统总方框图如图 4 所示。 具 体的功能设置已通过该图做了直观的说明。通过主控芯片控制各传感器输入的信号，控制方式由软件来实现，其中包括六个红外传感器用来检测障碍物，四个传感器用来检测侧面障碍， 2 个检测前方障碍。还有一个霍尔传感器用来检测路程相关的信号；除了处理这些信号单片机还通过 I/O 口控制直流电机和 LED的显示。在功能和作用上，我分成了四大部分：主控、驱动、避障和显示部分。 112233445566D DC CB BA AT i t l eN um be r R e vi s i
21、onS i z eBD a t e : 2007- 6- 25 S he e t of F i l e : D : F a vor i t e s . 电源 .S C H D O C D r a w n B y :12J4V i n3ADJ1+ V out2L M 338U 14104C 14I N 4001D125V / 470uFC 22R E S 4R 60104C 15V C CGNDR E S 4R 1025V / 470uFC1图 2-1 系统总原理框图 避障电路 （ 1）障碍物探测方案的选择 方案 一：脉冲调制的反射式红外线发射接受器。由于采用该有交流分量的调制信号，则可大幅度减
22、少外界干扰；另外红外线接受管的最大工作电流取决于平均电流。如果采用占空比小的调制信号，再品均电流不变的情况下，顺势电流很大（ 50 100mA），则大大提高了信噪比。并且其反应灵敏，外围电路也很简单。它的优点是消除了外界光线的干扰提高了灵敏度。 方案二：采用超声波传感器，如果传感器接收到反射的超声波，则通知单片机前方有障碍物，如则通知单片机可以向前行驶。市场上很多红外光电探头也都是基于这个原理。这样不但能准确完成测量，而 且能避免电路的复杂性。 由以上两种方案比较可知。方案二要比方案一优势大，市场上很多红外观点探头也都基于这个原理。其电路简单，工作可靠，性能比较稳定。从而避免了电路的复杂性。 避障电路采用漫反射式光电开关进行避障。光电开关是集发射头和接收头于一体的检测开关，其工作原理是根据发射头发出的光束，被障碍物反射，接收头据此做出判断是否有障碍物。当有光线反射回来时，输出低电平；当没有光线反射回来时，输出高电平。单片机根据接收头电平的高低做出相应控制，避免小车LED 显 示模块（时间、里程） TMS320LF2407 侧体左侧红外传感器 车体右侧红外传感器 车体左前红外传感器 车体右前红外传感器 控制直流电机驱动器 路程传感器
