电机伺服控制和PID算法简介

1、电机伺服控制和PID算法详解1电机伺服控制技术简介所谓伺服控制，通常也就是指闭坏控制，即通过反馈环节，测量被控制对象的变化，用 以修正电机输出的控制技术。对于要求不高的应用，通常采用简单的开环控制。例如，给直流有刷电机的两根引线通 电，电机就会旋转；施加的电圧越高，电机转速越高，力量越大。但是在很多需要精密控制 的场合，仅仅这种方式还是不够的，还碍要依靠一定的反馈装置，将电机的转速或位宣信息 反馈给微控制器或其他的机械装置，通过 淀的算法变成町以调节电机拧制伫勺的输出，从 而使电机的实际转速、位置等参数与我们所希望的一致。机器人控制是一个精度要求比较高 的领域，例如.基于以下的一些考虑.机器人

2、平台需要使用闭环控制。a）开坏控制情况卜，移动机器人在爬坡时，电机速度会I、降。更糟糕的是，当双轴独立驱 动的移动机器人以一定的角度接近斜坡时。每一个车轮转速的下降值将会不同，结果是 机器人的实际运动轨迹是沿着一条曲线而不是直线行进。b）不平坦的地面会造成移动机器人的两个车轮转速Z间的差异。如果转速较低的车轮的驱 动电机没有得到相应的电压补给，移动机器人将偏移既定的路线。c）由于安装工艺、负载不完全均衡等原因，即使是完全匹配的两个电机，并在相同的输入 电压条件下，他们的速度有时仍会产生不同，即转速差。d）如果釆用的是PWM控制，即使在PWM信号占空比不变的条件卜，随着电池电斥的逐 渐下降，电机

3、供给电压也会随之降低，从而导致电机的转速与给定值不完全一致。综介以上的一些考虔，必须选择闭环控制的方式，其工作流程如下图所示：闭环系统中 加上了反馈环节（通常机器人的驱动电机使用的是增帚:式光学编码器）。在闭环控制系统中， 速度指令值通过微控制器变换到功放驱动电路，功放驱动电路再为电机提供能量。光学编码 器用丁测量车轮速度的实际值并将其回馈给微控制器。基丁实际转速号给定转速的差值，即 ''偏差"，驰动器按照一定的计算方法（如PID算法）调整相应的电压供给，如此反复，H 到达到给定转速。闭环控制模型示总图速度闭环控制示盘图这里，电机的控制算法起到了十分关键的作用。控制算

4、法的过程是：通过接受指令速度 值，通过运算向电机提供适当的驰动电斥，尽快地和尽呈平稳的使电机转速达到指令速度值, 并维持这个速度值。换言之，一旦电机速度达到了指令速度值，即使在各种不利的因素(如 斜坡、碰撞之类等市电机转速发生变化的因素)的干扰下也应该保持该速度值不变。现在己 经有形形色色的控制算法被研究出来，实际上，控制理论本身就是一门独立的学科。这里仅 介绍经典、流行的比例积分微分(PID:Proportional Integral Derivative)控制算法。2 PID调节器及其软件实现PID控制器是控制系统中技术比较成熟，而且是应用最广泛的一种控制器。它的结构简 单，参数容易调整，

5、不一定需要系统的确切数学模型，因此在工业的0个领域中都有应用。PID控制器最先出现在模拟控制系统中，传统的模拟PID控制器是通过硬件(电子元 件、气动和液压元件)来实现它的功能。随看计算机的出现，把它移植到计算机控制系统中 來，将原來的硬件实现的功能用软件来代替，因此称作数字PID控制器，所形成的-整套 算法则称为数字PID算法。数字PID控制器与模拟PID控制器相比，貝有非常强的灵活性, 可以根据实验和经验在线调试参数，因此町以得到更好的控制性能。这里将介绍PID控制 的基本原理、数字PID控制算法及改进以及数字PID控制器的参数选择。3模拟式PID调节器在模拟控制系统中，控制器址常用的控制

6、规律是PID控制。为了说明控制器的工作原 理，我们先看一个例子。上图是 个小功率直流电机调速原理图。给定转速nO(t)与实际转 速n(tz)进行比较，其差值e(t)=nO(t)-n(t)z经过PID控制器调整后输出电压控制信号 u(t)ru(t)经过功率放大后，驱动直流电动机改变其转速。常规的模拟式PID控制系统原理框图如上图所示。该系统由模拟PID控制器和被控对 象组成。图中的r(t)是给定值，y(t)是系统的实际输出值，给定值和实际输出值构成控制偏 差e(t) =r(t)y(t),其中e(t)作为PID控制器的输入，u(t)作为PID控制器的输出和被控 对彖的输入。因此模拟式PID调节器的

7、控制规律为u (t > Kp e(t) 4- J-Je(t)dt 4-Td+Ti odt式中Kp比例系数;1-积分常数：%-微分常数：u0 控制常最：在模拟PID中，比例坏节的作用是对偏差瞬间作出快速反应。偏差一旦产生，控制器 立即产生控制作用，使控制量向减少偏差的方向变化'控制作用的强弱取决于比例系数Kp , Kp越大，控制越强；但是过大的Kp会导致系统震荡，破坏系统的稳定性。由上式可以看出，只有当偏差存在时，第一项才有控制量输出。所以，对大部分被控制 对彖（如II流电机的调压调速），需要加上适当的与转速和机械负载有关的控制常量,否 则，比例环节将会产生静态误差。积分环节的作用

8、是把偏差的积累作为输出。在控制过程中，只要有偏差存在，积分环节 的输出就会不断增大。直到偏差e（t）=O,输出的u（t）才可能维持在某一常量，使系统在给 定值（t）不变的条件下趙于稳态。因此，即使不加控制常量,也能消除系统输出的静态 误差。积分环节的调节作用虽然会消除静态误差，但是也会降低系统的响应速度，增加系统的 超调量。积分常数E越人，积分的积累作用越弱。堆人积分常数£会减慢静态误差的消除 过程，但是可以减少超调量，提高系统的稳定性。所以，必须根据实际控制的具体要求來确 定丁】。实际的控制系统除了希望消除静态误差外，还要求加快调节过程。在偏差出现的瞬间， 或在偏差变化的瞬间，不但

9、要对偏差量作出立即响应（比例环节的作用），而且要根据偏差 的变化趋势预先给出适当的纠正。为了实现这T乍用，可在PI控制器的基础上加入微分环 节，形成PID控制器。微分环节的作用是阻止偏差的变化。它是根据偏差的变化趙势（变化速度）进行控制。 偏差变化的越快，微分控制器的输出就越人，并能在偏差值变人之前进行修正。微分作用的 引入，将冇助于减少超调量，克服怠荡，使系统趋于稳定。特别对于高阶系统非常有利，它 加快了系统的跟踪速度。但微分的作用対输入信兮的噪卢很敬感，対那些噪曲较人的系统一 版不用微分，或在微分起作用之前先对输入信号进行滤波。适当的选择微分常数 ,可以使微分环节的作用达到最优。4数字式P

10、ID调节器由于计算机的出现，计算机进入了控制领域。人们将模拟PID控制规律引入到计算机 （或其他微处理器）中來。对上式的PID控制规律进行适当的变换，就可以用软件來实现 PID控制，即数字PID控制。数字PID控制算法町以分为位豐式PID控制算法和增量式PID控制算法。a）位置式PID控制算法由于计算机或单片机控制是一种釆样控制，它只能根据采样时刻的偏差值计算控制杲, 而不能像模拟控制那样连续输出控制最，进行连续控制。由于这一特点，式3中的积分项 和微分项不能直接使用，必须进行离散化处理。离散化处理的方法为：以T作为采样周期, k作为采样序号则离散时间kT对应着连续时间匕用求和的形式代替积分，

11、用增量的形式 代替微分，可作如下近似变换t«kT(k=O,l/乙 )Je(t)dtb£e(jT) =Te(j)0J=0J=0de(t)e(kT)_e(k_l)T _ 鱼土dt "TT-上式中，为了表示方便，将e(kT)简化成e(k)等。将上式代入式中，就可以鬧离做的PID 殍式为：U(k) = Kpek + 舌艺勺 + 卡( ek_x) + u0或£日丁u(k) = Kpek + Ki；勺 + Kd(ek 一 耳“)+ %式中 k-采样序号? k=0zl,2uk第k次采样时刻的计算机输出值；ek第k次采样时刻输入的偏差值；e-第k-1次采样时刻输入的偏差

12、值；Ki积分常数，Ki = KpT/g：Kd微分常数，Kd = Kpl；/T：u0开始进行PID控制时的原始初值：如果采样周期取得足够小，则式中的近似计算町获得足够精确的结果，离散控制过程与 连续控制过程十分接近。它给出了全部控制量的人小，因此被称为全量式或位置式PID控 制算法。这种算法的缺点是：由于全量输出，所以每次输出均与过去状态有关，计算时要进 行累加,工作量大,;并且，因为计算机输出量对应的是执行机构的实际位置,如果计算机 出现故障，输出量将会人幅度变化，会引起执行机构的人幅度变化，何町能造成-定事故, 这在生产实际中是不能允许的。因此采用増量式PID控制算法：PID川:以是損独H制

13、2：；的的川f 制啟的卯I*、加I加卜: 由式可得p i-itu(kl)= Kp6.x + 亍谷勺 + 爷(勺. 一 勺_2) + *将上式与式相减，整理町得：Au(k)=u(k)-u(k 1)=陌6+ 半( 斗】+ )=!Cp(g +丰 +半&%) = KpA 4-Kiek 4-KdA2式中 Aek =卷ek-u q = q _ 2也+q.2 =_ g-i；Ki = Kp ;Kd = KpE；T由上式可以看出，如果计算机控制系统采用恒定的采样周期T, 一旦确定了 A,B,C,就 可以利用前后三次测量值的偏差，求出控制增量。实际中位置式增最的PID控制算法可以通过增最式控制算法推出递推计算公式% =叽 +在实际的应用中，根据貝体的系统要求，需要采用一定的改进算法。1、死区设定：由于系统本身的需要精度或者是固有的机械特性设定一定的控制死区，町以认为控制量在此控制区内己经达到了稳定。为此，设定死区deadjinej如下计算： Ujj = Uiz 如果 | e* |v dead _line;Uk = 1&- + Allk z 如果 | * |x dead _