本发明涉及物流搬运设备运动控制技术领域，具体地说是一种物流搬运设备s曲线加减速速度规划与控制方法。

背景技术：

在物流设备中，沿直线轨迹运行的机构非常普遍。出于机械安装限制或降低成本的考虑，很多采用了开环控制方式，即仅控制速度，通过认址片(孔)、编码器(尺)等认址装置完成位置定位。开环控制方式难以对全行程进行速度曲线规划，一般采用多段速调速，接近目标位置时采用低速定位。在这种方式下，速度控制不稳定，调速对设备和货物冲击大，定位过程时间长。

技术实现要素：

针对现有技术的不足，本发明提供一种物流搬运设备s曲线加减速速度规划与控制方法，实现了无极调速，并实现了位置反馈对速度的闭环校验与控制，避免了对设备和货物的冲击，显著提高了定位效率，克服了传统的多轨迹段s曲线速度控制算法计算复杂，难于在plc上实现的问题。

本发明为实现上述目的所采用的技术方案是：

一种物流搬运设备s曲线加减速速度规划与控制方法，包括以下步骤：

步骤1：获取目标位置，根据目标位置和约束条件规划速度曲线段，确定s曲线形式；如果s曲线为四段s曲线，则通过二分迭代法重新规划速度曲线段，执行步骤2；否则根据确定的s曲线形式执行步骤2；

步骤2：计算s曲线各速度曲线段分段点的位移和速度；

步骤3：根据位置反馈和分段位移比较，确定所在的速度曲线段，对速度曲线进行插补输出，同时对位移进行闭环比例控制。

所述约束条件包括加加速度jmax、加速度amax、最大速度vmax以及运动路径长度s。

所述s曲线包括：四段s曲线、五段s曲线、六段s曲线和七段s曲线；其中

四段s曲线包括四个速度曲线段和速度曲线段后的低速定位段；速度曲线段依次为加加速段、减加速段、加减速段、减减速段，且加加速段与减减速段的位移相等，减加速段和加减速段的位移相等；

五段s曲线包括五个速度曲线段和速度曲线段后的低速定位段，速度曲线段依次为加加速段、减加速段、匀速段、加减速段、减减速段和低速定位段，且加加速段与减减速段的位移相等，减加速段和加减速段的位移相等；

六段s曲线包括六个速度曲线段和速度曲线段后的低速定位段，速度曲线段依次为加加速段、匀加速段、减加速段、加减速段、匀减速段、减减速段和低速定位段，且加加速段与减减速段的位移相等，匀加速段和匀减速段的位移相等，减加速段和加减速段的位移相等；

七段s曲线包括七个速度曲线段和速度曲线段后的低速定位段，速度曲线段依次为加加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段、减减速段和低速定位段，且加加速段与减减速段的位移相等，匀加速段和匀减速段的位移相等，减加速段和加减速段的位移相等。

所述确定s曲线形式包括以下过程：

(1)当s>2(slow+smid+shigh)+sfinal时，为七段s曲线；

(2)当s＝2(slow+smid+shigh)+sfinal时，为六段s曲线；

(3)当s2(smid+shigh)+slow+sv+sfinal时，为加加速段，其中：

设定位移

输出速度

(2)当不符合(1)条件，且s>2shigh+smid+slow+sv+sfinal时，为匀加速段，其中：

设定位移

输出速度vt＝v1+amaxt+(st-ssum+s)kp，t∈[0,tramp]；

(3)当不符合(1)和(2)条件，且s>shigh+smid+slow+sv+sfinal时，为减加速段，其中：

设定位移

输出速度

(4)当不符合(1)-(3)条件，且s>shigh+smid+slow+sfinal时，为匀速段，其中：

设定位移st＝slow+smid+shigh+v3t；

输出速度vt＝v3+(st-ssum+s)kp，t∈[0,tramp]；

(5)当不符合(1)-(4)条件，且s>smid+slow+sfinal时，为加减速段，其中：

设定位移

输出速度

(6)当不符合(1)-(5)条件，且s>slow+sfinal时，为匀减速段，其中：

设定位移

输出速度vt＝v5-amaxt+(st-ssum+s)kp，t∈[0,tramp]；

(7)当不符合(1)-(6)条件，且s>sfinal时，为减减速段，其中：

设定位移

输出速度

(8)当不符合(1)-(7)条件，且s≤sfinal时，为低速定位段，其中：

输出速度vt＝vs；

(9)当实际位置与目标位置偏差绝对值满足给定的允许误差时，输出速度

vt＝0，运动过程结束；否则返回(1)。

本发明具有以下有益效果及优点：

1.本发明仅通过plc编程即可实现低成本的s曲线速度控制，不增加额外硬件投入，计算实时性强，控制效果稳定。

2.本发明提供了一种基于plc、变频器、位置认址装置的低成本直线定位控制系统，其中plc是控制的核心，用于速度曲线规划、位置数据的采集、无极闭环调速控制；变频器用于执行电机的调速；位置认址装置用于反馈位置数据。

3.本发明实现了根据加加速度、加速度、速度的设定值以及运动路径长度，自动预规划多轨迹段速度曲线，该方法计算量小，实时性强，克服了传统的多轨迹段s曲线速度控制算法计算复杂，难于在plc上实现的问题。

4.本发明还提供了一种速度控制方法，该方法通过定时中断对规划的速度曲线进行实时插补，作为速度设定值；通过位置反馈环节修正速度设定值并判断跟随误差是否过大，通过反馈控制系统保证了速度曲线的跟踪速度和精度，实现了速度曲线的准确拟合。

5.本发明避免了传统多段速开环控制速度切换时冲击大，低速定位段时间长的问题，通过闭环控制，保证了速度控制精度。

附图说明

图1是系统控制结构框图；

图2是多种分段的s形速度曲线图；

图3是方法流程图。

具体实施方式

以下结合附图以及具体实施例，对本发明的技术方案进行详细描述。

图1示出了本发明的系统控制结构框图。

其硬件包括plc、变频器、电机和位置认址装置。

plc是控制的核心，用于速度曲线规划、位置数据的采集、无极闭环调速控制；

变频器用于执行电机的调速；

电机用于执行物流搬运设备的拖动与定位。

位置认址装置用于反馈位置数据。

位置环反馈环节采用比例(p)调节,kp为位置环增益：即plc实时采集位置认址装置反馈的位置数据，并与经规划速度曲线计算得出的设定位移值比较，其差值乘以增益kp后叠加规划速度曲线的插补值作为速度输出设定值。

s曲线算法的核心思想是让加速度不产生突变，从而使被控对象的速度控制具有快速、平稳的特性。完整的s形速度曲线包括七段，如图2.a所示：加速过程包含加加速段(0～t1)、匀加速段(t1～t2)及减加速段(t2～t3)；减速过程包含加减速段(t4～t5)、匀减速段(t5～t6)及减减速段(t6～t7)；加速和减速之间通过匀速段(t3～t4)衔接。

在实际应用中，由于被控对象约束条件的限制，s形曲线往往不能完整地包含七段，如图2.d所示，缺少匀速段，呈现六段速度曲线；如图2.c所示，缺少匀加速段和匀减速段，呈现五段速度曲线；如图2.b所示，缺少匀加速段、匀减速段和匀速段，呈现四段速度曲线。

为保证计算简便，应使加加速段和减加速段对称。且在加速过程中，应尽量满足使加速度a可达到amax。因此，程序中强制使最大速度vmax不小于和初速度vs之和。其中jmax为加加速度。

为保证定位不超调，在s曲线分段外，增加了终定位的低速定位段，定位段距离可根据设备运动特性灵活配置。

当运动命令下达后，plc首先根据约束条件：加加速度jmax、加速度amax、最大速度vmax以及运动路径长度s(即当前位置与目标位置的距离值)确定s曲线形式,即确定曲线段是由七段、六段、五段还是四段构成及每段的含义。

因为加速段与减速段对称。加加速段与减减速段位移相等，以slow表示；匀加速段与匀减速段位移相等，以smid表示；减加速段与加减速段位移相等，以shigh表示；匀速段以sv表示；低速定位段以sfinal表示,通过将约束条件加加速度jmax、加速度amax、最大速度vmax代入下述公式计算slow、smid和shigh：

式中，tramp为加减速时间，vs为定位段速度，v1为加加速段终速度，v2为匀加速段终速度，v3为匀速段速度。

根据计算结果，对s曲线的形式推论如下：

当s>2(slow+smid+shigh)+sfinal时，此时为七段s曲线，如图2.a所示；

⑵当s＝2(slow+smid+shigh)+sfinal时，此时为六段s曲线，不含匀速段，如图2.d所示；

⑶当s2(smid+shigh)+slow+sv+sfinal时，为加加速段，其中：

设定位移

输出速度

⑵当不符合⑴条件,且s>2shigh+smid+slow+sv+sfinal时，为匀加速段，其中：

设定位移

输出速度vt＝v1+amaxt+(st-ssum+s)kp

⑶当不符合⑴-⑵条件,且s>shigh+smid+slow+sv+sfinal时，为减加速段，其中：

设定位移

输出速度

⑷当不符合⑴-⑶条件,且s>shigh+smid+slow+sfinal时，为匀速段，其中：

设定位移st＝slow+smid+shigh+v3t

输出速度vt＝v3+(st-ssum+s)kp

t∈[0,tramp]

⑸当不符合⑴-⑷条件,且s>smid+slow+sfinal时，为加减速段，其中：

设定位移

输出速度

⑹当不符合⑴-⑸条件,且s>slow+sfinal时，为匀减速段，其中：

设定位移

输出速度vt＝v5-amaxt+(st-ssum+s)kp

t∈[0,tramp]

⑺当不符合⑴-⑹条件,且s>sfinal时，为减减速段，其中：

设定位移

输出速度

⑻当不符合⑴-⑺条件,且s≤sfinal时，为低速定位段，其中：

输出速度vt＝vs

⑼当实际位置与目标位置偏差绝对值满足给定的允许误差时，输出速度vt＝0，运动过程结束。

以上，对本发明速度曲线规划和插补算法，及其在plc硬件平台上的具体实现进行了详细介绍。本领域技术人员在本发明上做出的变型或延伸也属于本发明保护范围之内。