基于k60的电磁引导式智能循迹物流车的制作方法
【专利摘要】本发明公开了一种基于K60的电磁引导式智能循迹物流车，其主要由微处理器模块，以及通过数据线与微处理器模块相连的机械系统、电磁传感模块、电源管理模块、电机驱动模块、舵机驱动模块、超声波停车模块、上位机模块组成。本发明不仅提高了整个车间系统的运作效率、服务质量，降低了成本，而且提升了企业核心竞争力和经济效益；并且该电磁引导式循迹物流车占地面积小，方便美观，提高了企业的形象。
【专利说明】
基于K60的电磁引导式智能循迹物流车
技术领域
[0001]本发明涉及物流车，特别是一种基于K60的电磁引导式智能循迹物流车。
【背景技术】
[0002]继德国的“工业4.0”推出之后，“中国制造2025”的既定方略也公布于众。而我国的制造业多为劳动密集型的传统产业，特别是对于间歇流水线，产品会出现在工序时间较长的工作地上等待加工和工序时间较短的工作地的负荷不充分的现象(见文献:钱芝网，王晓光，张李.基于柔性生产的生产物流平衡策略研究[J].工业工程与管理，2012，02:13-20+50.)。除此之外，与工业3.0的流水线只能大批量生产的刚性生产模式所不同的是，“工业4.0”流水线要求可以实现小批量、多批次生产，最小的批量可以达到一件，也就是说，可以为消费者量身定制孤版商品，即柔性生产模式(见文献:梁东.对柔性生产的认识[J].商业研究，2001，09:26-28.)。柔性生产的精髓在于实现弹性生产，提高企业的应变能力，不断满足用户的需求(见文献:徐宁.大规模定制下的企业生产柔性研究[D].西安电子科技大学，2007)。这就使得产品的生产工序不再是一成不变的，需要根据不同的订单采用不同的生产工序。这样，生产线上的各个工位之间就会有不同的组合，需要应变性和准确性良好的智能运输设备在各工位之间智能配送生产零件。
【发明内容】
[0003]本发明所要解决的技术问题是:提供一种基于K60的电磁引导式智能循迹物流车，以解决企业在生产零件智能配送过程中所面临的各种问题，实现工业生产高度智能化、自动化、柔性化。
[0004]本发明解决其技术问题采用以下的技术方案:
[0005]本发明提供的基于K60的电磁引导式智能循迹物流车，其主要由微处理器模块，以及通过数据线与微处理器模块相连的机械系统、电磁传感模块、电源管理模块、电机驱动模块、舵机驱动模块、超声波停车模块、上位机模块组成。
[0006]所述的微处理器模块，装在物流车的中部，用于对传感器所输入的信息进行处理并对其它模块进行实时控制，由微控制器、复位按钮、电源接口、JTAG下载接口和其它输入输出接口组成，所述微控制器采用K60微控制器芯片。
[0007]所述的机械系统，用于对物流车的驱动和转向，由电机驱动模块、齿轮传动机构和舵机驱动模块组成，其中:电机驱动模块采用RS-540电机对后轮进行驱动，电机转动后，通过齿轮机构将动力传给后轮，驱动后轮运动，同时两个后轮之间有差速器，以辅助物流车更顺畅的转弯;舵机驱动模块采用SD-5舵机，舵机转动一定角度通过摆杆将动力传递给前轮，完成左右打角，实现物流车的转弯。
[0008]所述的电磁传感模块，装在物流车的前端，其由以电信号相连的LC谐振电路、滤波电路、放大电路、检波电路组成，其根据LC谐振的原理，选取1mH电感和6.8nF电容作为LC谐振电路，产生感应电流，再通过滤波、放大、检波，然后将结果送入单片机进行AD处理，以判断道路当前信息。
[0009]所述的电机驱动模块，装在物流车后部后轮附近，用于驱动电机，由电机和驱动电路组成，其中:驱动电路采用BTN7971高强度电流半桥电机驱动芯片，该电路利用两片BTN7971构成一个完整的全桥驱动，以实现电机的正转、反转和刹车制动。
[0010]所述的舵机驱动模块，装在物流车前端前轮附近，用于控制舵机，由电源稳压电路和舵机组成，其中:舵机用电源稳压电路进行供电，该电源稳压电路由NCP3020芯片及其外围元件组成，通过稳压，使用6V的电源给舵机供电。
[0011 ]所述的超声波停车模块，装在物流车两侧，用于判断是否到达目标机床处，该超声波停车模块由集成在一块PCB上的超声波发射头和超声波接收头组成，对目标机床进行探测。
[0012]所述的上位机模块，其包括蓝牙通讯模块和PC端的调控软件，蓝牙通讯模块用于实现上位机与微处理器之间的数据传输，PC端的调控软件用于对某一零件加工工序顺序的输入，由通讯口设置区、工序输入区、工序显示区和数据接收区组成，其中:通讯口设置区用于对通讯口进行设置，工序输入区用于工艺人员输入相应的工序，工序显示区用于显示当前所输入或正在执行的工序，数据接收区用于接收物流车所反馈的信息。
[0013]本发明基于K60的电磁引导式智能循迹物流车设置了路径生成算法，其根据物流车当前位置和目标位置自动生成物流车的行进路径。
[0014]所述路径生成算法包括以下步骤:
[0015]步骤1:首先检测模拟当前坐标值是否和目标坐标重合，如重合，输出转向指令，若不重合，检测当前方向是否在目标坐标相对于模拟当前坐标值的方向上，如不在正确的方向，则采用步骤2尝试将物流车调整到正确的方向上；
[0016]步骤2:由于物流车可能处于直线部分，不能进行方向调整操作，处于这样的状况下，则优先将物流车向前移动一步，使物流车处于能够调整方向的情况下；当物流车能够调整方向时，首先尝试将物流车的方向调整到目标坐标相对于模拟当前坐标值的方向上;若目标坐标相对于模拟当前坐标值的方向恰好处于物流车的后方，而物流车不能进行原地180°换向，需采用步骤3通过自由换向的方式解决这一问题；
[0017]步骤3:判断物流车的位置，检测物流车的死区，具体是采用模拟的方式进行死区检测，即:若物流车转向这个方向是否会形成死区，由于死区全部集中在道路的外围，所以仅仅需要对道路外围检测即可;在得出死区信息后，将物流车转向死区以外的方向，若没有形成死区，则按照算法中设定的优先级转向优先级较高的方向；
[0018]重复以上步骤1、步骤2、步骤3，直到模拟当前坐标值与目标位置的坐标重合，此时整个计算过程结束，将每个步骤生成的转向指令输出，得到最终的路径。
[0019]本发明与现有技术相比具有以下主要的优点:
[0020]本发明物流车针对工业4.0生产体系下，不同工位之间的生产零件在配送时，小车运行路线的选择与寻迹问题。它能够在上位机多路径选择系统的监控下，在岔路口选择正确的方向，沿着预先铺设的电线轨道网格运动。当工厂因市场变化而改变生产线时，只需要将电线重新铺设即可。不仅提高了整个车间系统的运作效率、服务质量，降低了成本，而且提升了企业核心竞争力和经济效益。并且该电磁引导式循迹物流车占地面积小，方便美观，提高了企业的形象。
[0021]本发明物流车能够根据工艺人员在上位机端设定的生产工序，自动生成行进路线，将零件配送至指定工位，实现预定的生产工序，从而形成一条柔性的生产线。即在不改变车间构造的前提下，只需根据不同的产品需求，设定不同的生产工序，零件即可在物流车的配送下到达各个工位完成加工，实现柔性生产。
[0022]本发明物流车设置了多路径选择算法，其可以根据技术人员所输入的加工工序，自动生成行进路线，并在电磁循迹算法识别到岔路口后，控制物流车转向。最终达到将不同的零件按照技术人员指定的加工工序，智能配送至各个工位的目的，实现柔性生产。
【附图说明】
[0023 ]图1是电磁传感模块中的传感器放大电路原理图。
[0024]图2是电机驱动电路原理图。
[0025]图3是舵机电源稳压电路原理图。
[0026]图4是微处理器供电电路原理图。
[0027I图5是上位机界面展示图。
[0028]图6是模拟工厂场地坐标处理示意图。
[0029]图7是路径生成算法流程图。
[0030]图8是模拟车间场地示意图。
【具体实施方式】
[0031]下面结合实施例及附图对本发明作进一步阐述，但不限定本发明。。
[0032]本发明提供的基于K60的电磁引导式智能循迹物流车，主要由微处理器模块，以及通过数据线与微处理器模块相连的机械系统、电磁传感模块、电源管理模块、电机驱动模块、舵机驱动模块、超声波停车模块、上位机模块组成。本发明以k60芯片为主控制器，利用电磁传感器识别路径信息和判断是否到达岔路口。微处理器模块根据电磁传感器所采集到的信号，控制行车电机转动和舵机打角实现物流车的电磁循迹和多路径选择。
[0033]所述的微处理器模块，装在物流车的中部，用于对传感器所输入的信息进行处理并对其它模块进行实时控制，由微控制器、复位按钮、电源接口、JTAG接口和其它输入输出接口组成。所述微控制器采用K60微控制器芯片，其具有以下性能:IEEE 1588以太网，全速和高速USB 2.0On-The-Go带设备充电探测，硬件加密和防窜改探测能力。丰富的模拟、通信、定时和控制外设从100LQFP封装256KB闪存开始可扩展到256MAPBGA IMB闪存。大闪存的K60系列器件还可提供可选的单精度浮点单元、NAND闪存控制器和DRAM控制器，其具有以下几种存储单元:编程flash存储单元，FlexMemory，用于程序运行的RAM，SRAM，扩展存储或外围总线接口(FlexBus)，串行编程接口(EzPort)。(见文献:单片机嵌入式应用的在线开发方法[M]，邵贝贝.北京:清华大学出版社，2004:16-22)。
[0034]所述的机械系统，用于对物流车的驱动和转向，由电机驱动模块、齿轮传动机构和舵机驱动模块组成，其中:电机驱动模块采用RS-540电机对后轮进行驱动，电机转动后，通过齿轮机构将动力传给后轮，驱动后轮运动，同时两个后轮之间有差速器，以辅助物流车更顺畅的转弯;舵机驱动模块采用SD-5舵机，舵机转动一定角度通过摆杆将动力传递给前轮，完成左右打角，实现物流车的转弯。
[0035]所述的电磁传感模块，是物流车最重要的模块之一，其能够对变化的磁场信号作出灵敏的检测，对道路状况的检测起着至关重要的作用。该电磁传感模块装在物流车的前端，如图1所示，其由以电信号相连的LC谐振电路、滤波电路、放大电路、检波电路组成，其根据LC谐振的原理，选取I OmH电感和6.8nF电容作为LC谐振电路，产生感应电流，再通过滤波、放大、检波，然后将结果送入单片机进行AD处理，以判断道路当前信息。
[0036]所述的电机驱动模块，装在物流车后部后轮附近，用于驱动电机，由电机和驱动电路组成，其中:如图2所示，驱动电路采用BTN7971高强度电流半桥电机驱动芯片，该电路利用两片BTN7971构成一个完整的全桥驱动，可以很好地实现电机的正转、反转和刹车制动。
[0037]所述的舵机驱动模块，装在物流车前端前轮附近，用于控制舵机，由电源稳压电路和舵机组成，其中:舵机用电源稳压电路进行供电，该电源稳压电路由NCP3020芯片及其外围元件组成，如图3所示，通过稳压，使用6V的电源给舵机供电。较高的电压可以提高舵机的响应速度，但过高电压容易导致舵机工作不稳定(见文献:学做智能车一挑战“飞思卡尔”杯，卓青，黄开胜，邵贝贝..北京航空航天出版社，2007.)。
[0038]所述的超声波停车模块，装在物流车两侧，用于判断是否到达目标机床处，该超声波停车模块由超声波发射头和超声波接收头组成，其中:超声波发射头和超声波接收头集成在一块PCB上，对目标机床进行探测。
[0039]所述的上位机模块，其包括蓝牙通讯模块和PC端的调控软件，蓝牙通讯模块用于实现上位机与微处理器之间的数据传输，PC端的调控软件用于对某一零件加工工序顺序的输入，如图5所示，由通讯口设置区、工序输入区、工序显示区和数据接收区组成。其中，通讯口设置区用于对通讯口进行设置，工序输入区用于工艺人员输入相应的工序，工序显示区用于显示当前所输入或正在执行的工序，数据接收区用于接收物流车所反馈的信息。
[0040]为了计算出物流车的最优路径，本发明设置了路径生成算法，该算法可以根据物流车当前位置和目标位置自动生成物流车的行进路径，属于路径规划一类的问题。该算法对车间场地坐标进行了处理，如图6所示，其中的直线表示模拟车间场地中的电磁引导线，方框表示道路两侧的机床。为了便于计算机表示和运算，将模拟车间场地中的位置以坐标的形式表示出来，将交点和拐角处的坐标设为偶数点，从而可以将机床处的点以整数的形式表示出来，避免使用浮点型数据，节省内存空间，降低运算量。
[0041 ]所述路径生成算法包括建立坐标、规划路径步骤。
[0042]建立坐标后，可以较为简单地找出两点间最短的路径。虽然循迹物流车采用的是舵机控制前轮实现转向，因而难以实现原地转向180°，增大了路径规划的难度，但是本发明算法仍然可以在不能原地转向180°的情况下生成最优路径。
[0043]规划路径时采用模拟运行的方式，即先获取当前坐标和目标坐标，模拟运行，每次改变模拟当前坐标值，并记录每次模拟运行的相应转向指令，直到模拟运行的物流车到达目标坐标，即模拟当前坐标值和目标坐标值重合时，路径规划完成，物流车按照模拟运行所得到的转向指令运行。
[0044]所述的路径生成算法，如图7所示，具体如下:
[0045]步骤1:首先检测模拟当前坐标值是否和目标坐标重合，如重合，输出转向指令，若不重合，检测当前方向是否在目标坐标相对于模拟当前坐标值的方向上，如不在正确的方向，则采用步骤2尝试将物流车调整到正确的方向上。
[0046]步骤2:由于物流车可能处于直线部分，不能进行方向调整操作，处于这样的状况下，则优先将物流车向前移动一步，使物流车处于能够调整方向的情况下。当物流车能够调整方向时，首先尝试将物流车的方向调整到目标坐标相对于模拟当前坐标值的方向上。若目标坐标相对于模拟当前坐标值的方向恰好处于物流车的后方，而物流车不能进行原地180°换向，需采用步骤3通过自由换向的方式解决这一问题。
[0047]步骤3:判断物流车的位置，检测物流车的死区(不能前进的方向)，具体是采用模拟的方式进行死区检测，即:若物流车转向这个方向是否会形成死区，由于死区全部集中在道路的外围，所以仅仅需要对道路外围检测即可。在得出死区后，将物流车转向死区以外的方向，由于在任意一个结点处，物流车最多只能向两个方向转向，所以排除死区后通常只剩下一个方向，若没有死区，则按照算法中设定的优先级转向优先级较高的方向。
[0048]重复以上步骤1、步骤2、步骤3，直到模拟当前坐标值与目标位置的坐标重合，此时整个计算过程结束，将每个步骤生成的转向指令输出，得到最终的路径。
[0049]下面以物流车从坐标(O，3)，方向向上，到坐标(O，I)的路径为例说明路径生成算法:
[0050]物流车位于(0，3)，方向向Y轴正方向，目标为(0，I)，正确的方向应当是向Y轴负方向。由于物流车处于直线部分，不能进行转向，根据步骤2，物流车应向Y轴正方向运动，模拟当前坐标值更新为(O，4)，可以进行转向，但左转或右转均不能转至正确的方向，根据步骤3，算法找出左转为死区，所以右转并前进至下一信号点，模拟当前坐标值更新为(2，4)。此时，正确的方向为向Y轴负方向或向X轴负方向，当前位置可以转至Y轴负方向，所以，根据步骤2，物流车右转向Y轴负方向。此时，方向朝Y轴负方向，在正确的方向上，可以前进，模拟当前坐标值更新为(2，2)，此时依旧在正确的方向上，继续前进，模拟当前坐标值更新为(2，O)。正确方向为向X轴负方向或向Y轴正方向，可以右转至X轴负方向。此时在正确的方向上前进，模拟当前坐标值更新为(0，0)。正确方向为Y轴正方向，可以右转至Y轴正方向，再前进一格，模拟当前坐标值更新为(0，I)。此时，模拟当前坐标值与目标坐标重合，路径计算完成，输出每一步得到的转向指令，物流车即按照得到的转向指令进行运动到达目标地点。
[0051]实际生产中，工厂技术人员根据个性化定制的生产工序，将一系列的目标地点输入系统，物流车即可自动生成一系列的动作指令，引导物流车到达一个个目标地点，完成零件的配送。并且，本程序中采用队列的形式存储目标地点，同时不断更新模拟当前坐标值，由于采用链式数据结构，目标坐标点更新速度快，存储量大，在内存允许的前提下，理论上可以存储无限多的目标点，且目标点的数量不会影响程序执行的速度。这使得本物流车可以胜任工厂非常复杂的生产工序。
[0052]本发明提供的上述基于K60的电磁引导式智能循迹物流车，不仅能够根据柔性生产的要求，在车间硬件结构不变的情况下，将零件智能配送至各工位，实现企业在工业4.0体系下“按需生产，个性定制”的发展目标。并且，在“中国制造2025”既定方略的影响下，未来用于物流行业的智能车辆将向着更加智能化和自主化发展，在企业中的需求也必然非常强烈。因此，本智能循迹物流车的研究具有十分重要的理论意义和现实意义。
[0053]本发明提供的上述基于K60的电磁引导式智能循迹物流车，已经通过模拟车间场地来对其进行测试。白色道路中心铺有电磁引导线，形成直道、直角弯、丁字弯和十字弯四种道路情况。电磁引导线为直径为0.1-1.0mm漆包线，其中通有20kHz，10mA的交变电流，频率范围20k±lk，电流为100 ± 20mA，因此，在电磁引导线周围会产生磁场。物流车的电磁传感器根据检测到的磁场信号判断物流车的位置。加工所需要的机床分散在电磁引导线两侧，当物流车接近目标地点后即打开超声波测距模块，当物流车距离机床达到设定距离时，即停车卸下零件。
[0054]本发明提供的基于K60的电磁引导式智能循迹物流车，其工作过程是:工艺人员打开上位机输入相应零件的加工工序并确认后，物流车的路径生成算法则迅速生成最优路径，并按照此路径运行，在接近目标机床后即自动打开超声波模块，超声波模块在探测到已距离目标机床较近时，停止并卸下零件，并装载并运输加工后的零件到下一个目标机床，直到整个加工工序完成后，返回起始点继续配送。
【主权项】
1.一种基于K60的电磁引导式智能循迹物流车，其特征在于主要由微处理器模块，以及通过数据线与微处理器模块相连的机械系统、电磁传感模块、电源管理模块、电机驱动模块、舵机驱动模块、超声波停车模块、上位机模块组成。2.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的微处理器模块，装在物流车的中部，用于对传感器所输入的信息进行处理并对其它模块进行实时控制，由微控制器、复位按钮、电源接口、JTAG下载接口和其它输入输出接口组成，所述微控制器采用K60微控制器芯片。3.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的机械系统，用于对物流车的驱动和转向，由电机驱动模块、齿轮传动机构和舵机驱动模块组成，其中:电机驱动模块采用RS-540电机对后轮进行驱动，电机转动后，通过齿轮机构将动力传给后轮，驱动后轮运动，同时两个后轮之间有差速器，以辅助物流车更顺畅的转弯;舵机驱动模块采用SD-5舵机，舵机转动一定角度通过摆杆将动力传递给前轮，完成左右打角，实现物流车的转弯。4.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的电磁传感模块，装在物流车的前端，其由以电信号相连的LC谐振电路、滤波电路、放大电路、检波电路组成，其根据LC谐振的原理，选取I OmH电感和6.8nF电容作为LC谐振电路，产生感应电流，再通过滤波、放大、检波，然后将结果送入单片机进行AD处理，以判断道路当前信息。5.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的电机驱动模块，装在物流车后部后轮附近，用于驱动电机，由电机和驱动电路组成，其中:驱动电路采用BTN7971高强度电流半桥电机驱动芯片，该电路利用两片BTN7971构成一个完整的全桥驱动，以实现电机的正转、反转和刹车制动。6.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的舵机驱动模块，装在物流车前端前轮附近，用于控制舵机，由电源稳压电路和舵机组成，其中:舵机用电源稳压电路进行供电，该电源稳压电路由NCP3020芯片及其外围元件组成，通过稳压，使用6V的电源给舵机供电。7.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的超声波停车模块，装在物流车两侧，用于判断是否到达目标机床处，该超声波停车模块由集成在一块PCB上的超声波发射头和超声波接收头组成，对目标机床进行探测。8.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述的上位机模块，其包括蓝牙通讯模块和PC端的调控软件，蓝牙通讯模块用于实现上位机与微处理器之间的数据传输，PC端的调控软件用于对某一零件加工工序顺序的输入，由通讯口设置区、工序输入区、工序显示区和数据接收区组成，其中:通讯口设置区用于对通讯口进行设置，工序输入区用于工艺人员输入相应的工序，工序显示区用于显示当前所输入或正在执行的工序，数据接收区用于接收物流车所反馈的信息。9.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于该物流车设置了路径生成算法，其根据物流车当前位置和目标位置自动生成物流车的行进路径。10.根据权利要求1所述的基于K60的电磁引导式智能循迹物流车，其特征在于所述路径生成算法包括以下步骤: 步骤1:首先检测模拟当前坐标值是否和目标坐标重合，如重合，输出转向指令，若不重合，检测当前方向是否在目标坐标相对于模拟当前坐标值的方向上，如不在正确的方向，则采用步骤2尝试将物流车调整到正确的方向上； 步骤2:由于物流车可能处于直线部分，不能进行方向调整操作，处于这样的状况下，则优先将物流车向前移动一步，使物流车处于能够调整方向的情况下；当物流车能够调整方向时，首先尝试将物流车的方向调整到目标坐标相对于模拟当前坐标值的方向上;若目标坐标相对于模拟当前坐标值的方向恰好处于物流车的后方，而物流车不能进行原地180°换向，需采用步骤3通过自由换向的方式解决这一问题； 步骤3:判断物流车的位置，检测物流车的死区，具体是采用模拟的方式进行死区检测，即:若物流车转向这个方向是否会形成死区，由于死区全部集中在道路的外围，所以仅仅需要对道路外围检测即可;在得出死区信息后，将物流车转向死区以外的方向，若没有形成死区，则按照算法中设定的优先级转向优先级较高的方向； 重复以上步骤1、步骤2、步骤3，直到模拟当前坐标值与目标位置的坐标重合，此时整个计算过程结束，将每个步骤生成的转向指令输出，得到最终的路径。
【文档编号】G05D1/02GK106054880SQ201610409355
【公开日】2016年10月26日
【申请日】2016年6月12日
【发明人】吴彦春, 闫明辉, 张攀博, 虞苏璞, 高源
【申请人】武汉理工大学