跟随式自动行李箱

机电一体化大作业自动跟随行李箱设计组长：刘志鸿20127631(模型建模)组员:张平亮20127624(模型建模)郑顺20127627孙健锟20127633（控制系统）曾小良20127632胡宇涵20127626（传动，程序）指导老师：李敏2014年11月机电一体化大作业自动跟随行李箱设计第一页目录自动跟随行李箱设计..................................................................................................○总体思路......................................................................................................................二1.引言...........................................................................................................................二2.控制系统硬件设计思路...........................................................................................二2.1控制芯片的设计............................................................................................三2.2超声波传感器的设计....................................................................................三2.3电源的设计................................五2.4无线串口模块设计.......................................................................................五2.5直流电机驱动设计.......................................................................................六2.6蓄电池的选择................................................................................................九3.传动设计...................................................................................................................九4.程序设计...............................................................................................................十二5.模型结构...............................................................................................................十三机电一体化大作业自动跟随行李箱设计第二页自动跟随行李箱设计总体思路控制系统通过测距传感器感知主人的方位与距离，以实现智能跟随的功能。硬件电路主要采用单片机、超声波测距模块、电机驱动模块、无线串口信号传输模块；软件部分由上下位传感器调试程序构成。行李箱的驱动采用直流电机驱动，直流电机的动力来源由蓄电池提供。总体参数设计：行李箱的外观尺寸为70cm×40cm×20cm，总质量20kg、根据成人步行的一般速度设计跟随速度为1ms，正常工作时间为4小时。（计算所涉及的重力加速度210mgs。）1.引言随着社会的进步，智能化技术已经应用到各行各业，利用传感器自动导航的机器人已经得到应用，但使用CCD摄像头传感器，价格高，处理复杂，成本高，如果在自动跟随行李箱中采用超声波传感器，其传感器有体积小，处理简单，成本低等优点，因此本设计中采用超声波传感器，成功实现行李箱的自动跟随。2.控制系统硬件设计思路单片机通过采集行李箱前面5个超声波的值，判断行人的当前位置，然后控制直流电机，实现行李箱的转向，前进，后退等功能，单片机通过无线串口模块，把当前传感器数据传输给上位机，通过上位机数据显示来进行传感器好坏的判断和距离阀值的修改。机电一体化大作业自动跟随行李箱设计第三页图1控制系统硬件控制结构图2.1控制芯片的设计本控制器采用飞思卡尔公司生产的S12XS128芯片做控制芯片，S12芯片具有SCI,PWM等功能，同时具有丰富的I/O引脚，成本低廉是用方便，可以实现本控制器的功能。图2控制芯片电路图2.2超声波传感器的设计本传感器采用HY-SRF超声波模块，工作电压为5V，工作电流为15MA，工作频率40HZ，最远探测距离4.5M，最近探测距离2CM，探测角度为15度，在本设计中行李箱前部均匀分布有5个传感器，实现前方都可以探测到人，防止机电一体化大作业自动跟随行李箱设计第四页视野死角。图3超声波传感器电路图图4超声波模块机电一体化大作业自动跟随行李箱设计第五页2.3电源的设计在本设计中单片机，超声波模块，无线串口都需要5V供电，所以电源采用LM2940提供5V电压。LM2940电路原理如图所示。图5LM2940电路原理图2.4无线串口模块设计无线串口采用APC200-43多通道为功率嵌入式无线数据传输模块。APC200-43模块式高度集成半双工微功率无线数据传输模块，提供多个频道的选择，可在线修改串口速率，发射功率，发射频率等各种参数，同时具有小体积宽电压运行，传输距离较远可以应用与本设计中。图6APC200-43无线串口模块APC200A-43模块是高度集成半双工微功率无线数据传输模块，其嵌入高速单片机和高性能射频芯片。创新的采用高效的循环交织纠检错编码，抗干扰和灵敏度都大大提高，最大可以纠24bits连续突发错误，达到业内的领先水平。APC200A-43模块提供了多个频道的选择，能够透明传输任何大小的数据，而用机电一体化大作业自动跟随行李箱设计第六页户无须编写复杂的设置与传输程序，并提供UART/TTL，RS485以及RS232三种接口。同时小体积，宽电压运行，较远传输距，丰富便捷的软件编程设置功能，使APC200A-43模块能够应用与非常广泛的领域。2.5直流电机驱动设计在本设计中电机驱动模块采用L298N双H桥直流电机驱动器。本驱动供电范围5v-7v，最大功率20W。本模块可以控制2个直流电机的正反停。因为是四轮驱动，所以采用2块L298N双H桥直流电机驱动器可满足要求。轮半径R=5cm，跟随速度为1ms。假设行李箱质量分布均匀，则有每一个轮所受的力为50N。轮胎与路面的滚动摩擦系数如下表，将行李箱滚轮近似视为实心橡胶轮胎，路面为优质路面，将滚动摩擦系数近似取0.1。表1轮胎与路面的滚动摩擦系数表则有：每一个滚轮所受到的滚动摩擦力：0.1505fpfNNN，滚动摩擦力形成的力矩：25(510)Nm0.25NmfPfMPR；行李箱受到的总摩擦力：44520ffFPNN，机电一体化大作业自动跟随行李箱设计第七页总的摩擦力矩：440.251ffFPMMNmNm滚轮角速度：2120510vradradssr，转速：203.22rns。电机的输出转矩T和总的摩擦力矩相等，则有电机的输出功率13.2600.020272095499549TnPKwKwW。考虑到电机效率一般为80%，故实际电机功率P20=W=25W0.8P实根据摩擦力扭矩1N·M选择电机型号，并结合控制电路所选电机如下表加色行,具体参数见表格。表2JGB37-520直流电机参数表型号：JGB37-520参数表电压Voltage空载NoLoad堵转Stall减速器Reducer重量范围额定转速电流转速电流扭矩扭矩电流减速比尺寸WeightWorkableRatedSpeedCurrentSpeedCurrentTorqueTorqueCurrentRatioSize单位RangeVolt.Vrpmmarpmmakg.cmkg.cmA1:00mmg3-96v12803008967000.070.2826.25191443-9V6V8003006407000.10.4210191443-9V6V4253003407000.180.72218.8221503-9V6V2662002125000.31.2230221503-9V6V1422001134000.562.225624158机电一体化大作业自动跟随行李箱设计第八页3-9V6V88100704000.93.6290241583-9V6V61100483501.35.2213126.531{kw}6510954995493.765420pTNmn，446210.09812510.050.14.906251032JLDkgm,320(TJ)2.5(1.18752.5210)1923.352LLLLPKW,222262621111223210101010()J()4.9062510()4.90625100.1()251022.5210LDDJJWDkgm10052.6319nlNiN，mNiiaiTJJTTLimL86.3max2max2,2max2maxmax0.1050.1053.861.852.6822.56PTnLiW,说明：1J：轮1的转动惯量[2kgcm]；2J：轮2的转动惯量[2kgcm]；W：皮带和工件的总质量（kg）；机电一体化大作业自动跟随行李箱设计第九页1D：轮1的直径（cm）；2D：轮2的直径（cm）；综上，电机功率选择25W。2.6蓄电池的选择由于直流电机是该行李箱的主要耗能部件，因此我们在选择蓄电池的时候主要根据直流电机的参数来确定蓄电池的参数。根据前面的计算和查阅资料我们知道电机的功率为25W，工作电压为5V，工作电流为1A，正常工作时间为4小时。故蓄电池容量为Q=It=1×4=4Ah。根据市场上出售的蓄电池，我们选用6V，4.5Ah的蓄电池。蓄电池输出的电经DC-DC电路将电压转换为5V后输送到直流电机。考虑到成本，我们采用LC-RO64R5(6V4.5AH)铅酸蓄电池。表3LC-RO64R5(6V4.5AH)铅酸蓄电池基本参数外型尺寸：70*48*102，总高108（mm）类型：固定型蓄电池化学类型：铅酸蓄电池型号：LC-RO64R5NA6V4.5AH品牌：Panasonic松下额定容量：4.5AH3.传动设计传动模型如图7所示，机电一体化大作业自动跟随行李箱设计第十页图7电机、传动装置和负载的传动模型图中mJ电动机M转子的转动惯量m电动机M的角位移LJ负载L的转动惯量LFT摩擦阻转矩i----齿轮系G的总传动比根据传动关系有：mmmLLLi；其中：mmm、、分别为电动机的角位移、角速度、角加速度；LLL、、分别为负载的角位移、角速度、角加速度；LFT换算到电动机轴上的阻抗转矩为/LFFTi；LJ换算到电动机轴上的阻抗转矩为/LJP。设Tm为电动机的驱动转矩，在忽略传动装置惯量的前提下，根据旋转运动方程，电动机轴上的合转矩Ta