本系统设计的电机同步控制为了提高抗干扰能力，在一台电机速度受到外部扰动或人为干扰时两台电机仍能保持速度的同步，采用了带速度负反馈的主从式控制结构，因为其稳定性很好，这对爬楼轮椅是相当有利的，速度负反馈可以确保相应的控制精度。跟踪滞后问题可以通过pid算法和构建控制电路校正网络电路进行改进。
5 轮椅车控制算法设计
5.1 速度检测电路
测速元件是闭环调速系统中的关键元件，为了扩大调速范围，改善电动机的低速平稳性，要求测速元件低速输出稳定，波纹小，线性度好。常用的测速元件有模拟式测速元件和数字式测速元件。模拟式测速元件通常采用测速发电机；数字式测速元件采用光电式脉冲发生器。数字测速元件具有低惯量低噪声高分辨率和高精度的特点，有利于控制直流电机。在现代驱动控制系统中，为了提高速度反馈检测精度，正在摒弃直流测速发电机加A/D转换器的方案，而采用光电码盘直接数字测速的方案。
本系统采用增量式光电旋转编码器测量电机的速度。将光电编码器与电动机相连，当电动机转动时，带动码盘旋转，便发出相应的信号。光电编码器由光源，光电转盘，光敏元件和光电整形放大电路组成。光电转盘与被测轴连接，光源通过光电转盘的透光孔射到光敏元件上，当转盘转动时，光敏元件便发出与转速成正比的脉冲信号，为了判别电机的转向，光电编码器输出两路相隔90度电脉冲角度的正交脉冲。
利用光电编码器进行数字测速的常用方法有两种：M法和T法。
（1）M法测速：M法又叫定时计数法，是用计数器记取规定时间内光电编码器输出的脉冲个数来反映转速值，即在规定的时间间隔T内，测量编码器光栅所产生的脉冲数来获得被测的速度值。设编码器光栅每转一圈发出的脉冲数为Z，且在规定的时间T内，测得的脉冲数为M，则电机每分钟转数为：
n=60M/ZT
（5-1）
将转速实际值和测量值之差与实际值之比定义为测量误差率δ，δ反映了测速方法的准确性，δ越小，准确度越高。M法测速误差率取决于编码器的制造精度，以及编码器输出脉冲前沿和测速时间采样脉冲前沿不齐所造成的误差等，最多可以产生一个脉冲的误差。因此，M法测速误差率的最大值为：
60M60(M?1)?1ZT×100%? δ?ZT （5-2）
60MMZT由上式可知，误差率δ与M成反比，即脉冲数越大，误差越小，故M法测速适用于高速段。
（2）T法测速：T法又叫定数计时法，是用定时器记取光电编码器输出脉冲一个周
期内的高频时基个数，然后取其倒数来反应速度值，即测量相邻两个脉冲的时间间隔来确定被测速度。设编码器光栅每转一圈发出的脉冲数为Z，定时器的时基是一已知频率为F的高频脉冲，定时器的起始和终止由编码器光栅脉冲的两个相邻脉冲的起始沿控制。若定时器的读数为M，则电机每分钟的转速为：
n?60F/ZM （5-3） T法测速的误差产生原因与M法相仿，定时器的计数M最多存在一个脉冲的误差，因此，T法测速误差率的最大值为：
60F60F?1Z(M?1)ZM δ= （5-4） ×100%=60FM?1ZM低速时，编码器相邻脉冲间隔时间长，测得的高频脉冲个数多，误差小，故T法适用于低速段。
我们采用M法测速。所采用的光电编码器光栅每转一圈发出1000个脉冲。设电机工作在额定转速下，即n=500转/分，则在0.1秒的采样间隔内，计数器所应接受到的标准脉冲个数为M=500/60*0.1*1000=833个，可以看出，精度还是较高的。 本设计中速度反馈回路的原理图下图所示。
图5.1 速度反馈原理图
5.2 PID控制方法
5.2.1 PID控制方法介绍
PID控制是迄今为止最通用的控制策略，有许多不同的方法以确定合适的控制器参
数，根据现代理论的观点，PID调节器具有本质的鲁棒性、符合二次型最优控制选型原则、且具有智能化的专家特色。PID调节器及其改进型是在工业过程控制中最常见的控制器。
PID控制是比例积分微分控制的简称，本身是一种基于对“过去”、“现在”和“未来”信息估计的控制算法，最早出现在模拟控制系统中，通过硬件（电子元件，气动和液压元件）来实现。
控制器系统原理图如图5.2所示。
过 去 现 在 对 象 未 来
图5.2 模拟PID控制系统原理图
PID的三种控制规律可以组成不同的线性控制器。在电力传动控制系统中，常采用的串联校正控制装置有比例微分（PD）控制器、比例积分（PI）控制器及比例积分微分（PID）控制器。由PD控制器构成的超前校正可以提高稳定裕度并获得足够的快速性，但稳态精度可能受到影响；由PI控制器构成的滞后校正，可以保证稳态精度，但快速性不佳；用PID控制器实现的滞后-超前校正兼有二者的优点，可以全面提高系统的控制性能。
连续控制系统中的模拟PID控制规律为:
1tde(t)?? u(t)?Kp?e(t)??e(t)dt?Td （5-5） ?0Tidt??式中, u ( t ) 控制器的输出 e ( t ) 控制量的偏差 Kp 比例系数 Ti 积分时间常数 Td 微分时间常数 (1)比例环节
比例环节对偏差是即时反应的，偏差一旦出现，调节器立即产生控制作用，使输出量朝减小偏差的方向变化，控制作用的强弱取决于比例系数Kp。比例调节器虽然简单快速，但对于系统响应为有限值的控制对象存在静差。加大比例系数Kp可以减小静差，但过大会使系统的动态质量变坏，引起输出量震荡,甚至导致系统不稳定。
(2)积分环节
为了消除在比例调节中的残余静差，可在比例调节的基础上加入积分调节。积分调节具有累积成分，只要偏差e不为零，它将通过累积作用影响控制量u，从而减小偏差，直到偏差为零。如果积分时间常数Ti大，则积分作用弱，反之为强。增大Ti将减慢消除静差的过程，但可减小超调，提高稳定性。引入积分环节的代价是降低系统的快速性。 (3) 微分环节
为了加快控制过程，有必要在偏差出现或变化的瞬间，按偏差变化的趋势进行控制，使偏差消灭在萌芽状态，这就是微分调节的原理。微分作用的加入将有助于减小超调，克服震荡，使系统趋于稳定，特别对高阶系统非常有利，它加快了系统的跟踪速度，但对噪声非常敏感，使用前需要对输入信号进行滤波。 5.2.2 数字式增量PID控制算法
计算机控制是一种采样控制，它只能根据采样时刻的偏差值计算控制量。因此，连续PID控制算法不能直接使用，需要采用离散化方法，根据采样时刻的偏差值计算控制量，离散化得：
??TkTd u(k)?Kp?e(k)??e(j)??e(k)?e(k?1)?? （5-6）
Tij?0T??式中 k为采样序号，k=0,1,2,3…
如果采样周期足够小，这种离散逼近相当精确。式中u（k）为全量输出，它对应于被控对象的执行机构第k次采样时刻应达到的位置。因此，上式称为PID位置型控制算式。
可以看出，按PID位置型控制算式计算u(k)时，输出值与过去所有状态有关。当执行机构需要的不是控制量的绝对数值，而是其增量时(如步进电机的驱动)，可导出下式：
u(k)?u(k)?u(k?1) （5-7）
TTd?? ?Kp?e(k)?e(k?1)?e(k)??e(k)?2e(k?1)?e(k?2)??
TiT??