1 前言

近年来, 自动控制技术高速生长, PLC控制技术已广泛应用在工业、军事、农业、航空航天以及日常生活的各个领域。本文以S7-200smart控制平面货仓为例, 构建码料小车走出直线运行轨迹的构想, 可为相关企业进行系统革新提供借鉴。

2 系统概述

平面货仓系统共由称重区、货物传送带、托盘传送带、机械手装置、码料小车和一个3*3平面货仓区组成, 系统俯视图如图1所示。系统运行历程如下:货物首先经过称重区称重, 然后经过货物传送带将货物运送至SQ2位置, 再由机械手将货物取至SQ4处的托盘上, 最后由码料小车将货物连同托盘运送至货仓区, 码放至差别的存储位置。其中货仓区的正视图如图2所示。

图2 平面货仓正视图   

图1 平面货仓系统俯视图  

本文仅讨论平面货仓区码料小车运行轨�

？刂�, 现设定码料小车的横轴左右运行由电机M3伺服电机驱动, 码料小车的纵轴上下运行由电机M4步进电机驱动, 电机旋转以“顺时针旋转为左行或上行, 逆时针旋转为右行或下行”为准。

2.1 纵横轴控制硬件接线图

系统由S7-200smart、以太网、伺服电机、步进电机等组成, 硬件接线图如图3所示。S7-200smart的CPU�

？樾秃盼�6ES7288-1ST30-0AA0, 伺服选用型号为台达ASDA-B2, 步进电机选用型号为KINCO 3M458, 现设定PLC的Q0.1为步进电机的脉冲信号输出点, Q0.7为步进电机的偏向信号输出点, Q0.0为伺服电机的脉冲信号输出点, Q0.2为伺服电机的偏向信号输出点。系统输入点只设定了I0.0为伺服和步进的原点, I0.1为起动信号。

图4 起始点与目标  

图3 系统硬件接线图点之间的数学模型 

2.2 直线轨迹实现原理

要使码料小车能走出直线轨迹, 那么只要能知道横轴与纵轴的行进路程, 就可以设定纵横轴的运行速度, 使得双轴都同时抵达目标点。起始点与目标点直线距离和横轴距离已知, 以B2货仓为例, 如图4所示, xy直线距离已知设为c, ox距离已知设为b, oy距离未知设为a, 凭据三角函数, 求出α的度数, 再凭据三角函数, 求出a的距离。这时a、b的长度均为已知情况, 抵达了设定目的。同理平面货仓内的任何一个仓位都可用此要领实现。

3 系统软件程序设计

本次设计使用的软件是STEP 7-Micro WIN SMART, STEP 7具有以下功效:硬件配置和参数设置、通讯组态、编程、测试、启动和维护、文件建档、运行和诊断功效等。

3.1 主程序设计

在主程序设计中, 主要考虑的问题是伺服电机使能驱动和步进电机使能驱动, 如图5, 然后是激活运动初始步和挪用运动子程序, 设置好相关参数后可以进入子程序设计环节。

图5 主程序  

3.2 子程序设计

在子程序设计环节, 要考虑如图6几个环节:伺服和步进的原点设置, 位移设置, 伺服和步进抵达预定位置的跳转步, 运动完成结束标记。

图6 子程序 

最后通过以太网通讯, 完成该任务的调试事情。

4 结语

基于S7-200smart的货仓码料系统, 应用了步进和伺服双轴驱动, 在双轴联动控制历程中, 接纳直线运行控制模式, 具有较高的控制精度和稳定性;且控制电路设计简单、调试便当。在实际控制历程中, 双轴电机的启动、停止、和速度控制都由程序界说, 调试时只需改变单轴的位移, 即可实现对双轴联动的控制, 无须改变系统硬件电路。该系统解决了PLC控制系统横纵轴之间同时起停, 具有调理实时、调理速度快、没有余差等特点, 为后期做组态监控提供了便当, 提高了企业的自动控制水平。本系统对双轴联动三角函数算法的优化以及实现高性能、高可靠性的货仓控制系统都有着十分重要的现实意义。