一种直驱转台位置控制系统及控制方法与流程

文档序号：11518815阅读：441来源：国知局

本发明涉及一种直驱转台位置控制系统及控制方法，属于自动控制技术领域。

背景技术：

pid算法控制结构简单,鲁棒性强，因此在工程实践中得到广泛应用。相比较模拟pid调节器,数字化pid调节器具有更大的灵活性。

基于pid调节器的控制系统中由于积分器的存在，控制量的超调往往是不可回避的问题，在位置控制系统中，受到速度最大值限定的非线性因素影响，当位置控制系统大范围调转时，位置超调量的绝对值较大，不仅使系统稳定性下降的主要原因，也使定位控制动态过程加长。

在数字pid中，可以较为方便控制积分的值，进而减小或消除因积分器的存在导致的超调。

技术实现要素：

为了实现本发明的目的，本发明提供了一种直驱转台位置控制系统及控制方法。

为了解决上述问题，本发明所采取的技术方案是：

一种直驱转台位置控制系统，包括控制器、电机驱动器、直驱电机、位置传感器和转台；控制器完成转台的位置控制，并将速度指令通过与电机驱动器之间的现场总线接口传输给电机驱动器，完成直驱电机的速度控制；直驱电机输出轴的一端与转台转轴相连，带动转台转动；直驱电机输出轴的另一端与位置传感器相连，实现直驱电机的位置检测，位置传感器检测的直驱电机轴位置信息通过与控制器之间的位置传感器接口传输给控制器。

所述的控制器包括处理器、现场总线接口、上位机接口和位置传感器接口；所述的处理器通过上位机接口接收位置给定（位置控制目标指令），通过位置传感器接口接收转台位置反馈（实际位置信息），在处理器中完成位置控制算法，并通过现场总线接口将速度指令输出到电机驱动器；所述的处理器为dsp或arm或plc，可根据实际情况具体选择。

所述的处理器中的位置控制算法包括位置给定、位置反馈、u(k)函数、u(k-1)函数、速度指令约束函数和速度指令。比例积分调节器的函数如式（1）：

（1）

其中：-比例系数

–积分系数；

u(k)-第k次采样时刻比例积分调节器输出

e(k)-第k次采样位置误差

式（1）中为第k次采样后所有位置误差的和与积分系数的乘积，即为比例积分调节器的积分器，在误差方向没有改变的情况下，积分器值符号不会改变，这是比例积分调节器控制时必然产生超调的原因，尤其是在大范围定位控制中超调量的绝对值较大。

为实现减小大范围位置定位时的超调量，本发明u(k)函数采用式（2）函数代替式（1）中u(k)函数：

（2）

分别为本次采样周期位置误差（即第k次采样误差）和上次采样周期位置误差（即第k-1次采样误差），的初始值为0，是函数的计算结果，在完成u(k)函数计算后依据u(k)函数的结果进行计算；为两种计算误差分界值，一般取的最大位置误差（对于转台，其最大误差为180度）；为直驱电机的最大转速值；初始化计算时，取。

当第k次位置误差绝对值时，；

通过这种分段控制方式，可以保证在不同的大范围定位时，最终超调量的一致性。

所述的函数式（3）：

（3）

当时，

特别地，设置系数，取值范围1.0~10.0，具备的特性是：值小，则控制响应快，但超调量大，值大，则控制响应减慢，超调量减小，因此值整定时根据系统实际需求确定；通过对最大值限制，达到控制式（1）中积分器的值，当大范围位置定位时（不失一般性，假设初始位置误差为正值），定位开始时时，采用计算的值；当位置误差时（此时转台位置反馈值接近位置给定值），采用计算的值，此时积分器开始积分控制，通过式（3）对进行了适当限定，积分器可以从负值开始积分，从而实现减小大范围定位时的超调量。

所述的速度指令约束函数计算如式（4），实现对速度指令的最大值限制。

（4）

即当时，；

当时，；

当时，。

一种直驱转台位置控制系统的控制方法，包括控制参数整定，所述的控制参数整定包括以下步骤：

（1）控制位置给定值，使，按常规方法完成、参数整定；

（2）整定值，首先取；

（3）控制位置给定值，使；

（4）查看超调量是否小于期望值，如大于期望值，值增加0.1，转到步骤（3）；

（5）完成参数整定。

本发明所达到的有益效果：

（1）、本发明的系统通过采样直驱电机带动转台转动，去除了机械减速箱的齿轮传动，不存在传动链齿隙，因而可以实现对转台的高精度位置控制；

（2）、本发明的系统在大范围角度定位时，通过误差分段控制和最后定位阶段的积分器积分起点值控制，达到有效控制超调量的目的。

附图说明

图1是本发明的组成示意图；

图2是本发明的控制器组成示意图；

图3是本发明的的位置控制算法示意图；

图4是本发明的位置控制算法的流程图。

具体实施方式

下面结合附图对本发明作进一步描述。

如图1所示，一种直驱转台位置控制系统，包括控制器、电机驱动器、直驱电机、位置传感器和转台；控制器完成转台的位置控制，并将速度指令通过与电机驱动器之间的现场总线接口传输给电机驱动器，完成直驱电机的速度控制；直驱电机输出轴的一端与转台转轴相连，带动转台转动；直驱电机输出轴的另一端与位置传感器相连，实现直驱电机的位置检测，位置传感器检测的直驱电机轴位置信息通过与控制器之间的位置传感器接口传输给控制器。

如图2所示，所述的控制器包括处理器（实际情况可选择dsp、arm或plc作为处理器,本实例选择arm）、现场总线接口(本实例选择can总线接口)、上位机接口（本实例选择uart接口）和位置传感器接口(本实例选择ssi)。所述的处理器通过上位机接口接收位置给定（位置控制目标指令），通过位置传感器接口接收转台位置反馈（实际位置信息），在处理器中完成位置控制算法，并通过现场总线接口将速度指令输出到电机驱动器。

如图3所示，所述的处理器中的位置控制算法包括位置给定、位置反馈、u(k)函数、u(k-1)函数、速度指令约束函数和速度指令等。比例积分调节器的函数如式（1）：

（1）

其中：-比例系数

–积分系数；

u(k)-第k次采样时刻比例积分调节器输出

e(k)-第k次采样位置误差

图4为直驱转台位置控制系统的位置控制算法流程图，分别为本次采样周期位置误差（即第k次采样误差）和上次采样周期位置误差（即第k-1次采样误差），的初始值为0，是函数的计算结果，在完成u(k)函数计算后依据u(k)函数的结果进行计算；为两种计算误差分界值，一般取的最大位置误差（对于转台，其最大误差为180度）；为直驱电机的最大转速值；初始化计算时，取。

为实现减小大范围位置定位时的超调量，本发明采用式（2）函数代替式（1）中u(k)的计算函数：

（2）

即当第k次位置误差绝对值时，；