1、机电一体化大作业自动跟随行李箱设计组长: 刘志鸿 20127631(模型建模)组员: 张平亮 20127624(模型建模) 郑 顺 20127627 孙健锟 20127633(控制系统)曾小良 20127632 胡宇涵 20127626(传动,程序)指导老师:李敏2014 年 11 月机电一体化大作业 自动跟随行李箱设计第 1 页目录自动跟随行李箱设计 .1总体思路 .21.引言 .32.控制系统硬件设计思路 .32.1 控制芯片的设计 .32.2 超声波传感器的设计 .42.3 电源的设计 .52.4 无线串口模块设计 .62.5 直流电机驱动设计 .72.6 蓄电池的选择 .103.传动设
2、计 .104.程序设计 .125.模型结构 .13机电一体化大作业 自动跟随行李箱设计第 2 页自动跟随行李箱设计总体思路控制系统通过测距传感器感知主人的方位与距离,以实现智能跟随的功能。硬件电路主要采用单片机、超声波测距模块、电机驱动模块、无线串口信号传输模块;软件部分由上下位传感器调试程序构成。行李箱的驱动采用直流电机驱动,直流电机的动力来源由蓄电池提供。总体参数设计:行李箱的外观尺寸为 70cm40cm20cm,总质量 20kg、根据成人步行的一般速度设计跟随速度为 ,正常工作时间为 4 小时。(计算1ms所涉及的重力加速度 。 )210gs1.引言随着社会的进步,智能化技术已经应用到各
3、行各业,利用传感器自动导航的机器人已经得到应用,但使用 CCD 摄像头传感器,价格高,处理复杂,成本高,如果在自动跟随行李箱中采用超声波传感器,其传感器有体积小,处理简单,成本低等优点,因此本设计中采用超声波传感器,成功实现行李箱的自动跟随。2.控制系统硬件设计思路单片机通过采集行李箱前面 5 个超声波的值,判断行人的当前位置,然后控制直流电机,实现行李箱的转向,前进,后退等功能,单片机通过无线串口模块,把当前传感器数据传输给上位机,通过上位机数据显示来进行传感器好坏的判断和距离阀值的修改。机电一体化大作业 自动跟随行李箱设计第 3 页图 1 控制系统硬件控制结构图2.1 控制芯片的设计本控制
4、器采用飞思卡尔公司生产的 S12XS128 芯片做控制芯片,S12 芯片具有 SCI,PWM 等功能,同时具有丰富的 I/O 引脚,成本低廉是用方便, 可以实现本控制器的功能。图 2 控制芯片电路图2.2 超声波传感器的设计本传感器采用 HY-SRF 超声波模块,工作电压为 5V,工作电流为 15MA,工作频率 40HZ,最远探测距离 4.5M,最近探测距离 2CM,探测角度为 15 度,在本设计中行李箱前部均匀分布有 5 个传感器,实现前方都可以探测到人,防机电一体化大作业 自动跟随行李箱设计第 4 页止视野死角。图 3 超声波传感器电路图图 4 超声波模块机电一体化大作业 自动跟随行李箱设
5、计第 5 页2.3 电源的设计 在本设计中单片机,超声波模块,无线串口都需要 5V 供电,所以电源采用LM2940 提供 5V 电压。LM2940 电路原理如图所示。图 5 LM2940电路原理图2.4 无线串口模块设计无线串口采用 APC200-43 多通道为功率嵌入式无线数据传输模块。APC200-43 模块式高度集成半双工微功率无线数据传输模块,提供多个频道的选择,可在线修改串口速率,发射功率,发射频率等各种参数,同时具有小体积宽电压运行,传输距离较远可以应用与本设计中。图 6 APC200-43无线串口模块APC200A-43 模块是高度集成半双工微功率无线数据传输模块,其嵌入高速单片
6、机和高性能射频芯片。创新的采用高效的循环交织纠检错编码,抗干扰和灵敏度都大大提高,最大可以纠 24bits 连续突发错误,达到业内的领先水平。APC200A-43 模块提供了多个频道的选择,能够透明传输任何大小的数据,而用机电一体化大作业 自动跟随行李箱设计第 6 页户无须编写复杂的设置与传输程序,并提供 UART/TTL,RS485 以及 RS232 三种接口。同时小体积,宽电压运行,较远传输距,丰富便捷的软件编程设置功能,使 APC200A-43 模块能够应用与非常广泛的领域。 2.5 直流电机驱动设计在本设计中电机驱动模块采用 L298N 双 H 桥直流电机驱动器。本驱动供电范围 5v-
7、7v,最大功率 20W。本模块可以控制 2 个直流电机的正反停。因为是四轮驱动,所以采用 2 块 L298N 双 H 桥直流电机驱动器可满足要求。轮半径R=5cm,跟随速度为 。假设行李箱质量分布均匀,则有每一个轮所受的力1ms为 50N。轮胎与路面的滚动摩擦系数如下表,将行李箱滚轮近似视为实心橡胶轮胎,路面为优质路面,将滚动摩擦系数近似取 0.1。表 1 轮胎与路面的滚动摩擦系数表则有:每一个滚轮所受到的滚动摩擦力:,0.15fpN滚动摩擦力形成的力矩:;25(10)m.5NfPfMR行李箱受到的总摩擦力:,4520ffFN机电一体化大作业 自动跟随行李箱设计第 7 页总的摩擦力矩: 40.
8、251ffFPMNm滚轮角速度:,2105vradrssr转速:。03.2rns电机的输出转矩 T 和总的摩擦力矩相等,则有电机的输出功率。1.60.2709549PKwW考虑到电机效率一般为 80%,故实际电机功率20=W5.8实根据摩擦力扭矩 1NM 选择电机型号,并结合控制电路所选电机如下表加色行,具体参数见表格。表 2 JGB37-520直流电机参数表型号:JGB37-520 参数表电压 Voltage 空载 No Load 堵转 Stall 减速器Reducer 重量范围 额定 转速 电流 转速 电流 扭矩 扭矩 电流 减速比 尺寸 WeightWorkable Rated Spee
9、d Current Speed Current Torque Torque Current Ratio Size 单位Range Volt.V rpm ma rpm ma kg.cm kg.cm A 1:00 mm g3-9 6v 1280 300 896 700 0.07 0.28 2 6.25 19 1443-9V 6V 800 300 640 700 0.1 0.4 2 10 19 1443-9V 6V 425 300 340 700 0.18 0.72 2 18.8 22 1503-9V 6V 266 200 212 500 0.3 1.2 2 30 22 1503-9V 6V 142
10、 200 113 400 0.56 2.2 2 56 24 1583-9V 6V 88 100 70 400 0.9 3.6 2 90 24 1583-9V 6V 61 100 48 350 1.3 5.2 2 131 26.5机电一体化大作业 自动跟随行李箱设计第 8 页, 31kw651095494.76542pT Nmn,4 46210.8.921032JLDkg ,30(TJ)2.5(17.5).5LLPK W2 2226 6113 1010()()4.90()4.90.().50LJWkgm ,2.619nlNi,mNii aTJTLimL 86.3mx2max2,2ax2ax0.1
11、50.15.52.6Pni W说明:轮 1 的转动惯量 ;J2kgcm:轮 2 的转动惯量 ;2:皮带和工件的总质量(kg);W:轮 1 的直径(cm);D:轮 2 的直径(cm);机电一体化大作业 自动跟随行李箱设计第 9 页综上,电机功率选择 25W。2.6 蓄电池的选择由于直流电机是该行李箱的主要耗能部件,因此我们在选择蓄电池的时候主要根据直流电机的参数来确定蓄电池的参数。根据前面的计算和查阅资料我们知道电机的功率为 25W,工作电压为 5V,工作电流为 1A,正常工作时间为 4 小时。故蓄电池容量为 Q=It=14=4Ah。根据市场上出售的蓄电池,我们选用6V,4.5Ah 的蓄电池。蓄电池输出的电经 DC-DC 电路将电压转换为 5V 后输送到直流电机。考虑到成本,我们采用 LC-RO64R5(6V4.5AH)铅酸蓄电池。表 3 LC-RO64R5(6V4.5AH)铅酸蓄电池基本参数外型尺寸: 70*48*102,总高 108(mm )类型: 固定型蓄电池化学类型: 铅酸蓄电池型号: LC-RO64R5NA 6V4.5AH品牌: Panasonic 松下额定容量: 4.5AH3.传动设计传动模型如图 7 所示,图 7 电机、传动装置和负载的传动模型