运动伺服控制

一、三环控制原理

1、首先是电流环，此环完全在伺服驱动器内部进行，通过霍尔装置检测驱动器给电机的各相的输出电流，负反馈给电流的设定进行PID调节，从而达到输出电流尽量接近等于设定电流，电流环就是控制电机转矩的，所以在转矩模式下驱动器的运算最小，动态响应最快。

2、第二环是速度环，通过检测的伺服电机编码器的信号来进行负反馈 PID 调节，它的环内 PID 输出直接就是电流环的设定，所以速度环控制时就包合了速度环和电流环，换句话说任何形式都必须使用电流环，电流环是控制的根本，在速度和位置控制的同时系统实际也在进行电流（转矩）的控制以达到对速度和位置的相应控制。

3、第三环是位置环，它是最外环，可认在驱动器和伺服电机编码器间构建也可以在外部控制器和电机编码器或最终负载间构建，要根据实际情况来定。由于位置控制环内部输出就是速度环的设定，位置控制模式下系统进行了所有 3 个环的运算，此时的系统运算量最大，动态响应速度也最慢。

运动伺服一般都是三环控制系统，从内到外依次是电流环速度环位置环。

1、首先电流环：电流环的输入是速度环PID调节后的那个输出，我们称为“电流环给定”吧，然后呢就是电流环的这个给定和“电流环的反馈”值进行比较后的差值在电流环内做PID调节输出给电机，“电流环的输出”就是电机的每相的相电流，“电流环的反馈”不是编码器的反馈而是在驱动器内部安装在每相的霍尔元件（磁场感应变为电流电压信号）反馈给电流环的。

2、速度环：速度环的输入就是位置环PID调节后的输出以及位置设定的前馈值，我们称为“速度设定”，这个“速度设定”和“速度环反馈”值进行比较后的差值在速度环做PID调节（主要是比例增益和积分处理）后输出就是上面讲到的“电流环的给定”。速度环的反馈来自于编码器的反馈后的值经过“速度运算器”得到的。

3、位置环：位置环的输入就是外部的脉冲（通常情况下，直接写数据到驱动器地址的伺服例外），外部的脉冲经过平滑滤波处理和电子齿轮计算后作为“位置环的设定”，设定和来自编码器反馈的脉冲信号经过偏差计数器的计算后的数值在经过位置环的PID调节（比例增益调节，无积分微分环节）后输出和位置给定的前馈信号的合值就构成了上面讲的速度环的给定。位置环的反馈也来自于编码器。

编码器安装于伺服电机尾部，它和电流环没有任何联系，他采样来自于电机的转动而不是电机电流，和电流环的输入、输出、反馈没有任何联系。而电流环是在驱动器内部形成的，即使没有电机，只要在每相上安装模拟负载（例如电灯泡）电流环就能形成反馈工作。

二、影响控制的因素

1、速度环主要进行PI（比例和积分），比例就是增益，所以我们要对速度增益和速度积分时间常数进行合适的调节才能达到理想效果。

2、位置环主要进行P（比例）调节。对此我们只要设定位置环的比例增益就好了。当进行位置模式需要调节位置环时，最好先调节速度环，位置环、速度环的参数调节没有什么固定的数值，要根据外部负载的机械传动连接方式、负载的运动方式、负载惯量、对速度、加速度要求以及电机本身的转子惯量和输出惯量等等很多条件来决定，调节的简单方法是在根据外部负载的情况进行大体经验的范围内将增益参数从小往大调，积分时间常数从大往小调，以不出现震动超调的稳态值为最佳值进行设定。