先进制造技术 机器人实例.docVIP

制作双轮直立自平衡机器人本设计采用两块Cygnal公司推出的C8051F005单片机分别作为“双轮直立自平衡机器人”（以下命名为Sway）和人机交互上位机的控制核 心。车体倾斜角度检测采用AD公司推出的双轴加速度传感器ADXL202及反射式红外线距离传感器。利用PWM技术动态控制两台直流电机的转速。上位机与 机器人间的数据通信采用迅通生产的PTR2000超小型超低功耗高速无线收发数传MODEM。人机交互界面采用240*128图形液晶点阵、方向摇杆及按 键。基于这些完备而可靠的硬件设计，使用了一套独特的软件算法，实现了Sway的平衡控制与数据交换。摘 要本设计采用两块Cygnal公司推出的C8051F005单片机分别作为“双轮直立自平衡机器人”（以下命名为Sway）和人机交互上位机的控制核心。车 体倾斜角度检测采用AD公司推出的双轴加速度传感器ADXL202及反射式红外线距离传感器。利用PWM技术动态控制两台直流电机的转速。上位机与机器人 间的数据通信采用迅通生产的PTR2000超小型超低功耗高速无线收发数传MODEM。人机交互界面采用240*128图形液晶点阵、方向摇杆及按键。基 于这些完备而可靠的硬件设计，使用了一套独特的软件算法，实现了Sway的平衡控制与数据交换。本设计的主要特色：高速（25MIPS）低功耗的SOC单片机为各种复杂算法的实现提供了保障，丰富的片内外设为高速数据采集及PWM调制信号的生成提供了方便，片内温度传感器方便对温度的采集。片内JTAG功能为程序的调试及对系统的现场编程提供了方便。 高效的H型PWM电路提高了电源的利用率，实现了电机的平滑变速。 双轴加速度传感器及光电传感器的使用提高了车体倾斜角度检测的精度，差分算法的应用提高了系统的抗干扰能力。 优化的软件算法，智能化的自动控制使车体运动准确平稳。 高速的无线数据传输给各种远程数据采集和智能控制提供了保障。 大屏幕液晶（蓝屏）显示及360度方向摇杆为人机交互提供了良好的界面。 一、 硬件方案的选择与论证根据设计要求，系统可以划分为几个基本模块，如下图所示。对各模块的实现，分别有以下一些不同的设计方案。车体系统模块组成无线控制上位机模块组成1、 MCU主控制器方案一：采用89S52单片机作为主控制器。优点：价格低廉，程序资源丰富，技术比较成熟。缺点：运算速度慢，很难担任复杂算法的计算工作；程序储存空间小，不能储存大规模程序代码；数字外设少，片内没有模数转换器，不能直接进行数据采集。方案二：采用PHILIPS公司出品的LPC2119 ARM7内核处理器。优点：处理速度快（指令速度可达60MIPS），可以担任大部分复杂算法的计算工作；片内外设非常丰富，可以进行实时数据采集，多种 数据通信方式可供选择。缺点：价格昂贵，对于已有51系列单片机开发经验的人员来说原有程序不兼容。方案三：采用Cygnal公司推出的C8051F005单片机。优点：具有与8051兼容的微控制器内核，与MCS-51指令集完全兼容，方便原有程序的 移植。指令速度大大提高（最高25MIPS）,可以担任复杂算法的运算工作。片内集成了一个12位100KSPS的多通道ADC子系统，2个电压输出 DAC、2个电压比较器、片内电压基准，这为进行实时的数据采集提供了方便。片内具有4个通用的16位定时器、一个具有5个捕捉/比较模块的可编程计数器 /定时器阵列（PCA）,这为生成PWM信号给电动机调速提供了方便，又不会过多占用CPU资源。片内拥有2304B内部数据RAM，32KB FLASH储存器，可以在系统编程与全速非侵入式JTAG调试，这为生成大量程序代码和在线调试提供了保证。基于上述理论分析，拟选择方案三。2、 倾角检测方案一：采用水银开关。优点：价格便宜，货源广泛，原理简单。缺点：输出开关量，不能线性调整。震动易受到干扰，很难应用于高速高噪声场合。方案二：采用光电接近传感器。优点：价格便宜，输出线性度好，方便对其输出的数据进行处理与调整。缺点：反射强度随着反射面材料或颜色的不同而改变，很难广泛适应不同的路面。方案三：采用AD公司生产的双轴加速度传感器ADXL202。优点：PWM输出，方便与单片机进行接口，线性输出，输出精度高，可以做高精度控制。缺点：价格昂贵，算法复杂。方案四：综合采用光电接近传感器与ADXL202。优点：既克服了光电传感器对材料与颜色的挑剔，又克服了ADXL202的算法复杂。基于上述考虑，拟采用方案四。3、 电机驱动调速模块方案一：采用电阻网络或数字电位器调整电动机的分压，从而达到调速的目的。但是电阻网络只能实现有级调速，而数字电阻的元器件价格比较昂贵。更主要的问题在于一般电动机的电阻很小，但电流很大；分压不仅会降低效率，而且实现很困难。方案二：采用