简单路径规划避障轮式移动机器人系统

1、基于简单路径规划的避障轮式移动机器人系统直流电动机驱动子系统设计1. 系统概述本设计的目的是设计一种基于简单路径规划的避障轮式移动机器人，完成在简单环境 下的避障跟踪任务。通过超声测距系统，测量小车与障碍物之间的距离。小车由两个直流 电机分别对两轮进行驱动；同时，通过电子罗盘系统，通过主控单片机的控制，进行姿态 调整；通过光电测速系统测量小车行进速度，并反馈给主控单片机，从而实时改变小车速 度。2. 设计方案本设计的移动机器人按照其功能可分为四个子系统（图1）：直流电动机驱动子系统、电子罗盘子系统、光电测速子系统和超声测距子系统。其中，直流电动机驱动子系统采用集成电路驱动器L293D控制机器人

2、左右两个直流电动机，电动机可以正转也可以反转，L293D的使能信号和方向控制信号由型号为AT89C52的51系列单片机的并行I/O 口使能或驱动。电机的调速采用脉宽调制（PWM ）方式进行，PWM信号时序由单片机定时器（可用 TO、T1和T2）产生。电子罗盘子系统选用电子罗盘、电子指南针相关检测地磁的数字罗盘芯片，提取地磁偏转信号，经 A/D转换或其它变换转换为二轴地磁偏角数字量采用串行传输方式传送给 主控单片机。光电测速子系统选用红外对管并配合安装于车轮上的光电码盘检测车轮转动的角位 移，并与单片机定时器配合计算出机器人小车移动的线速度和加速度，并将其传送给主控 单片机。超声测距子系统选用超

3、声换能装置，并采用带锁相环的音频译码集成芯片LM567，将小车距离障碍物的距离检测出来，并将其传送给主控单片机。图1系统结构由于移动机器人系统设计比较复杂，软硬件任务结合紧密，必须综合考虑软硬件资源，合理分配整个设计过程。下图2说明了整个系统的设计工作流程。图2.系统设计工作流程这里，我选取直流电机驱动子系统作为详细设计部分。3. 直流电机驱动子系统的详细设计3.1硬件选择3.1.1 AT89C52单片机是整个小车系统的核心，控制所有模块，本系统采用型号为AT89C52 （图3）的51系列单片机。AT89C52是美国ATMEL公司生产的低电压，高性能 CMOS 8位单片机，片内含 8k byt

4、es 的可反复擦写的Flash只读程序存储器和256 bytes的随机存取数据存储器（RAM ），器件采 用ATMEL公司的高密度、非易失性存储技术生产，与标准 MCS-51指令系统及8052产品引 脚兼容，片内置通用 8位中央处理器（CPU ）和Flash存储单元，功能强大 AT89C52单片机 适合于许多较为复杂控制应用场合。其主要性能参数：与MCS-51产品指令和引脚完全兼容; 8k字节可重擦写Flash闪速存储器； 1000次擦写周期；全静态操作：0Hz-24MHz ;三级加密程序存储器； 256X8字节内部RAM ; 32个可编程I/O 口线； 3个16位定时/计数器； 8个中断源；

5、可编程串行UART通道；低功耗空闲和掉电模式.AT89C52提供以下标准功能：8k字节Flash闪速存储器，256字节内部RAM , 32个I/O口线，3个16位定时/计数器，一个6向量两级中断结构，一个全双工串行通信口，片内振荡器及时钟电路。同时，AT89C52可降至OHz的静态逻辑操作，并支持两种软件可选的节电工作模式。空闲方式停止CPU的工作，但允许 RAM，定时/计数器，串行通信口及中断系统继续工作。掉电方式保存 RAM中的内容，但振荡器停止工作并禁止其它所有部件工作 直到下一个硬件复位。PDIP(T2JP1 0L (T2 EX) P1 1 匚P1.2EP1 3匚F1 4匚 (MOSI

6、j P1.5 (MISO) P1.BE (SCK) P1 7 ERSTC(RXD) P3.OEZ (TXD)P3 1 匚 (INTO) P3.2IZ INTi)P3 3CCTO) P3 4 匚 (T1)P3 5L (WR P3.6C (RD)P3 7L XTAL2LXTAL1匚GNDL140239338437536635734E3393210311130122913281427152616251724182319222021 vcc PO O ADO) PO 1 (AD1) P0 2 (AD2) P0 3 (AD3 P0.4 (AD4j PO S (AD5) P0.5 (AD6) P07 (A

7、D7) &WPP ALE/PROG PSEN P27(A15)n P2.6 (A14) P2.5(A13 P2.4 (A12) P2 3(A11) P2 2 (A10) P2.1 (A9)J P2 0 (A3)图3 AT89C52引脚排列图3.1.2L293D本设计采用的是双轮差速控制方式，每个车轮分别由一个直流电机单独控制，移动机器人的速度和转向的控制主要是通过对这两个电机的控制来实现的。我们采用集成电路驱 动器L293D控制机器人左右两个直流电动机。L293D是美国德州仪器生产的一款电机控制器件，该器件具有4个大电流半H驱动结构这种结构可以在 4.5 V36 V电压的下提供高达 600 m

8、A的电流。该器件主要用于驱动感性 负载，如继电器、螺线管、直流或者双极性步进电机等。L293D具有如下特性：每个电机可提供高达 600 mA的驱动电流；每个驱动提供高达 1.2 A的脉冲电流；宽电压范围 4.5 V36 V ;隔离的逻辑电平电源；热耗少；内部ESD保护；抗噪性能好L293D的引脚排列如图4所示*550UTPJT4GND0LI1PLT JINPUT )ENABLE 2图4. L293D引脚排列图引脚2、7、10、15为控制信号输入端，用于控制电机的工作状态。而引脚3、6、11、14为电机控制输出端，用于直接控制电机的动作。该器件的所有输入与 TTL兼容，其输出采用达林顿晶体管接收

9、器和伪达林顿源构成的“图腾柱”驱动电路。电机驱动使能由引脚1控制电机1，引脚9控制电机2。当EN引脚置为高电平，与之相对应的电机就处于使能状态，从而激活电机控制输出。与Vs端口隔离的Vss端口可提供逻辑输入，以减小电源功耗。L293D可以工作在0C 70C的范围内。3.2硬件设计硬件设计电路如图 5所示。KTAl pV.7C3+5Va卄 T O(iFr-;,6J_432J.o phrppppppXT1RST VCC+10V861L293D16 Ktzxff: OlSW-PHI.1VCCVM(N4 OUT1N2 OUT2IN1EN3.4 EN3,2EN3,C 14左图5.电机控制驱动电路采用2个

10、桥式电路的芯片 L293D直接控制2个电机。L293D是驱动二相和四相步进电 机的专用芯片，即内含 2个H桥的高电压大电流双全桥式驱动器，接收标准TTL逻辑电平信号，可驱动36V、2A以下的电机。L293D可驱动2个电机，3、6和11、14脚之间分别 接2个电动机。2、7、10、15脚接输入控制电平，控制电机的正反转，ENA、ENB接控制使能端，控制电机停转。单片机输出2组PWM波，每1组PWM波用来控制1个电机的速度。另外2个I/O 口可以控制电机的正反转。控制方法与控制电路都比较简单。即2、7脚控制第1个电机的方向，输入的ENA控制第1个电机的速度；10、15脚控制第2个电机的方向，输入的

11、ENB控制第2个电机的速度。单片机P1 口对L293D的控制如下表所示：表1. P1 口对L293D控制信号P1.0P1.1P1.2P1.3P1.4P1.5电机运动*00停止010111前进101011后退100111左转011011右转脉冲宽度调制(Pulse Width Modulation-PWM)控制，通常配合桥式驱动电路实现直流电机调速，非常简单，且调速范围大。它的原理就是脉冲宽度调制将输出信号的基本周期固定，通过调整基本周期内高电平工作周期的大小来控制输出功率。电机的转速和电机两端电压成正比例，而电机两端的电压与控制波形的占空比成正比，因此电机的速度与占空比成正比，占空比越大，电机

12、转得越快，当占空比达到1时，电机转速最大。在实际制作过程中采用软件模拟 PWM输出调制的方法，控制信号的频率不需太高，一般在1.5 kHz以下为宜。本设计最终采用的信号频率为1 kHz，在小车正常直线行进过程中，使能端直接接高电平，电机全速转动。在转弯时才进行占空比调制，占空比的大小决定了小车转向的快 慢，占空比太小时，电机几乎不转，转向最快，但有可能使小车摇摆不定；占空比太大 时，2电机转速差很小，小车将转向很慢。3.3软件设计主控单片机AT89C52主要用于接收控制信号并执行相应操作。主要包括小车的停止、前进、后退、左转、右转等。下图5给出了移动机器人主控软件设计流程。图5.主控软件流程图

13、以下给出单片机通过L293D控制电机的接口程序代码:.public_F_MotoRun_F_MotoRu n:.procpush bp tosp。bp=sp+3。r仁bp+1。r3=0xf3ff。P_IOA_Dir=r3。P_IOA_Attrib=r3 。r4=0xffff oP_IOA_Data=r4 。run:cmp r1,0。 jnz left 。/IOB3 input1 IOB4 input2 IOB5 input3 IOB6 input4 IOB0 En1 IOB1 En2r2=0x002b 。/0000 0000 0010 1011 r1=P_IOB_Data 。 r1=r1|r2

14、 。r2=0xffaf 。/1111 1111 1010 1111 r1=r1&r2 。P_IOB_Data=r1 。jmp finish 。left:cmp r1,1 。jnz right 。 r2=0x000b 。/0000 0000 0000 1011 r1=P_IOB_Data 。 r1=r1|r2 。r2=0xff8f 。/1111 1111 1000 1111 r1=r1&r2 。P_IOB_Data=r1 。jmp finish 。right:cmp r1,2 。jnz stop 。 r2=0x0023 。/0000 0000 0010 0011 r1=P_IOB_Data 。

15、r1=r1|r2 。r2=0xffa7 。/1111 1111 1010 0111 r1=r1&r2 。P_IOB_Data=r1 。jmp finish 。stop:r1=OxOOOO。/OOOO OOOO 0000 0000P_TimerA_Ctrl=r1 。P_TimerB_Ctrl=r1 。r2=0xff87。/1111 1111 1000 0111 r1=P_IOB_Data。r1=r1 &r2 。P_IOB_Data=r1 。fini sh:pop bp fromsp。call_ClearWatchDogretf.endp4.结束语经过一个学期的学习，从对移动机器人一无所知到有所了解，再到对其整体构架和内 部组成有了一定的了解，这个过程是艰辛的，也是快乐的。本设计中，主要对移动机器人 的直流电机驱动进行设计，其中包括软硬件的设计。由于是第一次