一、常用的控制算法
1.控制系统的基本结构：
控制系统的基本结构如图：
控制目的：
控制的根本目的就是要使控制对象当前的状态值与用户的设定值相同（最大限度的接近）。
基本思想：
用户设定值sv与被控制对象当前的值pv两者同时送入由特定硬件电路模型或特定的软件算法组成的控制算法逻辑中，利用不同的控制算法对sv和pv进行分析、判断、处理，从而产生当前应该输出的控制信号out,控制信号经过执行机构施加到控制对象上，从而产生预期的控制效果。
2.常用控制算法：位式控制
①二位式控制算法
二位式控制算法具体控制逻辑如图所示：
特点：
a. 二位式控制算法输出的控制量只有高低2种状态。
b. 执行机构使控制对象要不全额工作，要不就停止工作。当pv低于sv时全额工作，pv大于或等于sv时就彻底停止工作。如果控制对象是一个1000w的加热器，温度不到时就1000w全功率运行，温度达到时就停止工作。
c. 由于环境因素或控制系统传输延时或者控制对象本身的惯性等因素，控制效果往往是pv在sv的上下有一个较大的波动。
d. 在pv接近sv的临界点时，控制输出信号out往往在h和l之间频繁转换，导致执行部件的触点频繁开关动作，易产生干扰及缩短执行部件的寿命。
②.具有回差的二位式控制算法
具有回差的二位式控制算法具体控制逻辑如图所示：
特点：
a. 取sv的正负10%左右作为回差调节上下限，高于上限才开始输出l,低于下限才开始输出h;
b.避免了一般二位式控制算法在临界点时执行部件频繁动作。
c.因为控制对象只有全额运行或不运行两种状态，仍然存在一般二位式控制算法的缺点：pv总是在sv附近波动。
③三位式控制算法
三位式控制算法具体控制逻辑如图所示：
特点：
a.在二位式控制的基础上对控制对象的功率分成0功率（停止工作）、半功率、全功率三种情况（即三位）。
b.当前值低于设定值一定比例（一般10%）时out1和out2同时起控制作用，控制对象全功率运行；
c.当前值在设定值的正负10%范围时，out1单独作用，工作于半功率状态；
d.当前值达到或超过设定值时out1和out2都停止输出，控制对象停止工作。
e.相对一般二位式控制算法，三位式算法对控制对象的当前状态值做了简单的分析，并根据不同的当前状态值输出不同的控制信号。能够较好的对输出产生控制效果。
④小结
位式控制的主要特征：
a.控制算法只关注控制当前的状态值（pv）与设定值之间的差值—二者当前有差值就输出控制信号，二者当前无差值就不输出控制信号。
b…位式控制算法的输出信号状态单一，只输出了高低两种状态，这两种状态对应着控制对象的工作与不工作----如果是温度控制系统，就是加热器加热与不加热。
c.由于控制系统自身的延时或者控制对象自身的惯性，位式控制算法只能使控制对象当前的状态值在设定值附件波动，不能很好的跟踪在设定值的附近甚至相等。
1.pid控制算法的基本思想
pid控制控制算法具体控制逻辑如图所示：
pid算法是一种具有预见性的控制算法，其核心思想是：
①. pid算法不但考虑控制对象的当前状态值（现在状态），而且还考虑控制对象过去一段时间的状态值（历史状态）和最近一段时间的状态值变化（预期）,由这3方面共同决定当前的输出控制信号；
②.pid控制算法的运算结果是一个数，利用这个数来控制被控对象在多种工作状态（比如加热器的多种功率，阀门的多种开度等）工作，一般输出形式为pwm，基本上满足了按需输出控制信号，根据情况随时改变输出的目的。
2.pid算法分析
设某控制系统：用户设定值为sv(也就是希望通过pid控制算法使被控制对象的状态值保持在sv的附件)。
①从系统投入运行开始，控制算法每隔一段时间对被控制对象的状态值进行采样。由此，可得到开机以来由各个采样时间点被控制对象的状态值所形成的数据序列：
x1,x2, x3, x4, … xk-2,xk-1,xk
说明：
x1：开机以来的第一次采样值
xk: 目前的采样值（最近一次的采样值）
2>从这个采样值序列中提取出三方面信息：
①当前采样值xk与用户设定值sv之间的差值：ek
ek =sv-xk
分析ek:
ek>0：说明当前状态值未达标
ek=0：说明当前控制状态值正好满足要求
ek<0：说明当前状态值已经超标
结论：ek反应了控制对象当前值与设定值的偏差程度，可以根据ek的大小对输出信号out进行调整：偏差程度大out增大，偏差程度小out减小。即输出信号的强弱与当前偏差程度的大小成比例，所以根据ek的大小来给出控制信号out的当前值的算法称为比例控制（proportion）。用数学模型可以表示为：
pout=（kp*ek） out0
kp:一般称之为比例系数，可以理解为硬件上的放大器（或衰减器），适当选取kp将当前误差值ek
按一定的增益放大或缩小，以提高控制算法的相应速度。
out0:是一个常数，目的是为了当ek为0时，确保输出信号不为0，以不至于在当前值与设定值相等时控制器输出信号out为0，系统处于无控制信号的失控状态。
②将投入运行以来的各个采样值都与设定值相减，可得到开机以来每个采样时刻的偏差序列数据：
e1，e2，e3 …ek-2,ek-1,ek
说明：
e1：开机的第一个采样点与设定值的偏差
e1=sv-x1；
e2=sv-x2；
…
ek-2=sv-xk-2；
ek-1=sv-xk-1；
ek: 当前的采样值与设定值的偏差
ek=sv-xk
分析开机以来的误差序列：
每个偏差值可能有：>0，<0，=0这三种可能的值，因为从开机到现在，控制算法不断输出控制信号对被控对象进行控制，导致了过去这段时间有时候超标（ex<0）,有些时候未达标（ex>0）,有时候正好满足要求（ex=0）;如果将这些偏差值进行累加求代数和得到sk,即：
sk=e1 e2 e3 … ek-2 ek-1 ek
分析sk:
sk>0：过去大多数时候未达标
sk=0：过去控制效果较理想
sk<0：过去大多数时候已经超标
结论：1.通过对sk的分析，可以对控制算法过去的控制效果进行综合评估。体现了控制算法按照原来的方式输出的控制信号导致了现在的控制结果，所以应该利用这个值来对当前要输出的控制信号out进行修正，以确保控制对象会在将来的一小段时间尽快达到用户设定的值。
2.sk实际上是过去每个时间点的误差相加，与数学上的定积分运算类似，因此根据sk对输出信号进行调节的算法称积分（integral）算法。所以积分控制的数学模型为：
iout=(kp* ((1/ti)exdt)) out0
kp是一常数，其目的类似硬件上的放大器，用于将sk放大或衰减；
out0是一常数，为了在历史积分偏差值为0时确保系统有一个输出值，避免失控；
ti 是积分时间常数，取值越大会导致输出量out会越小，可理解为历史上已经很久的误差值都影响了当前的输出信号。取值越小，输出out会越强烈，可理解为积分只考虑了最近一段时间的误差。
实际中，如果系统已经运行“很长”一段时间了，那些早期采样的偏差值可以忽略他们对当前控制的影响，所以应该根据情况选择合理的ti值方能得到良好的控制效果。
③最近两次的偏差之差 dk
dk=ek-ek-1
说明：
ek：当前的偏差
ek-1: 基于当前的前一个采样时刻的偏差值（即上一次的偏差值）；
分析dk:
dk>0：说明从上一采样时刻到当前误差有增大趋势
dk=0：说明从上一采样时刻到当前误差平稳
dk<0：说明从上一采样时刻到当前误差有减小趋势
结论：
1. dk能够说明从上次采样到当前采样的这段时间被控制对象的状态变化趋势，这种变化的趋势很可能会在一定程度上延续到下一个采样时间点，所以可以根据这个变化趋势（dk的值）对输出信号out进行调整，达到提前控制的目的。
2. dk形如数学上的微分运算，反应了控制对象在一段时间内的变化趋势及变化量，所以利用dk对控制器输出信号进行调节的算法称为微分（differential）算法。可以用数学模型表达为：
dout=kp*(td(de/dt)) out0
kp：为一常数，可理解为硬件上的放大器或衰减器，用于对输出信号out的增益进行调整；
out0:为一常数，为了在dk为0时确保out都有一个稳定的控制值，避免失控。
td:叫微分时间常数，(犹如硬件上电感器的自感系数)td越大导致out增大，对输出信号产生强烈的影响。
3>pid算法的形成
1.比例、积分、微分三种算法的优缺点分析：
pout=（kpek） out0 --比例算法
iout=kp ( (1/ti) exdt) out0 --积分算法
dout=kp*(td(de/dt)) out0 --微分算法
比例算法: 只考虑控制对象当前误差，当前有误差才输出控制信号，当前没有误差就不输出控制信号，也就是说只要偏差已经产生了比例算法才采取措施进行调整，所以单独的比例算法不可能将控制对象的状态值控制在设定值上，始终在设定值上下波动；但是比例控制反应灵敏，有误差马上就反应到输出。
积分算法：考虑了被控制对象的历史误差情况，过去的误差状况参与了当前的输出控制，但是在系统还没有达到目标期间，往往会因为这些历史的误差对当前的控制产生了干扰（即拖后腿），使用不当反而搅乱当前的输出。但是在系统进入稳定状态后，特别是当前值与设定值没有偏差时，积分算法可以根据过去的偏差值输出一个相对稳定的控制信号，以防止产生偏离目标，起到打预防针的效果。
微分算法:单纯的考虑了近期的变化率，当系统的偏差趋近于某一个固定值时（变化率为0），微分算法不输出信号对其偏差进行调整，所以微分算法不能单独使用，它只关心偏差的变化速度，不考虑是否有偏差（偏差变化率为0时偏差不一定是0）.但是微分算法能获得控制对象近期的变化趋势，它可以协助输出信号尽早的抑制控制对象的变化。可以理解为将要有剧烈变化时就大幅度调整输出信号进行抑制，避免了控制对象的大幅度变化。
以上三种算法综合起来产生一个当前的控制量对控制对象进行控制，它们的优缺点互补，即形成经典的pid算法。
3.pid算法数学模型
out=pout iout dout
即：
out=((kpek) out0) (kp ( (1/ti) exdt) out0) (kp*(td(de/dt)) out0)
整理该式子得到：将各项的out0归并为out0。
out=kp(ek ((1/ti)exdt)) (td(de/dt))) out0
3.pid算法在单片机中的应用
1）pid算法在单片机中应用时，对积分和微分项可以作近似变换：
对于积分项可改写成：
n
i =1/ti∑ekt
k=0
即用过去一段时间的采样点的偏差值的代数和的代替积分。
t是采样周期，也叫控制周期，每隔t时间段进行一次pid计算。
对于微分项可改写成:
d=td((ek-ek-1)/t)
ek：本次偏差，ek-1上次的偏差值
2)位置式pid算法数学模型
由此可得到单片机中pid算法的表达式：
out=kp(ek ((1/ti)exdt)) (td(de/dt))) out0
=>
out=
n
kp(en (1/ti∑ekt) (td((ek-ek-1)/t))) out0
k=0
进一步展开得：
n
out=(kpek) (kp(t/ti)∑ek) (kp*(td/t)(ek-ek-1)) out0
k=0
令 ki= kp*(t/ti);
kd=(kp*(td/t)
故：
n
out=(kp*ek) (ki∑ek) (kd(ek-ek-1)) out0
k=0
程序设计时利用c语言或汇编语言可以方便实现这个计算公式。out即为本次运算的结果，利用out可以去驱动执行机构输出对应的控制信号，例如温度控制就可以控制pwm的宽度，电磁阀就可以改变电磁线圈电流以改变阀门开度，或者是可控硅的导通角度等；
这种pid算法计算出的结果（out值）表示当前控制器应该输出的控制量，所以称为位置式（直接输出了执行机构应该达到的状态值）。
3）增量式pid算法
位置式pid算法计算量较大，比较消耗处理器的资源。在有些控制系统中，执行机构本身没有记忆功能，比如mos管是否导通完全取决于控制极电压，可控硅是否导通取决于触发信号，继电器是否接通取决于线圈电流等，只要控制信号丢失，执行机构就停止，在这些应用中应该采用位置式pid。
也有一些执行机构本身具有记忆功能，比如步进电机，即使控制信号丢失，由于其自身的机械结构会保持在原来的位置等，在这些控制系统中，pid算法没有必要输出本次应该到达的真实位置，只需要说明应该在上次的基础上对输出信号做多大的修正（可正可负）即可，这就是增量式pid算法。
增量式pid计算出的是应该在当前控制信号上的调整值，如果计算出为正，则增强输出信号；如果计算出为负则减弱输出信号。
增量式pid算法数学模型：
如果用outk-1表示上次的输出控制信号值，那么当前的输出值应该为outk,这两者之间的关系为：
outk=outk-1 △out
△out即为应该输出的增量值；
上式变形得：
△out= outk- outk-1
本次的位置式算法输出：
n
outk=(kpek) (ki∑ek) (kd(ek-ek-1)) out0 --1式
k=0
上次的位置式算法输出：
n-1
outk-1=(kpek-1) (ki∑ek) (kd(ek-1-ek-2)) out0–2式
k=0
上述1式减2式即得到相邻两次的增量：
如前所述：
ki= kp*(t/ti);
kd=(kp*(td/t)
△out= outk- outk-1=
kp(ek-ek-1) ((kpt)/ti)ek (((kptd)/t)*(ek-2ek-1 ek-2))
ek：本次的偏差；
ek-1：上次的偏差
ek-2：上上次的偏差
kp：算法增益调节
ti ：积分时间
td: 微分时间常数
结论：
增量式pid的计算只需要最近3次的偏差（本次偏差，上次偏差，上上次偏差），不需要处理器存储大量的历史偏差值，计算量也相对较少，容易实现。
4）关于ti和td的理解：
在pid控制算法中，当前的输出信号由比例项，积分项，微分项共同作用形成，当比例项输出不为0时，如果积分项对运算输出的贡献作用与比例项对运算对输出的贡献一样时（即同为正或同为负时），积分项相当于重复了一次比例项产生作用的时间，这个
时间就可以理解为积分时间。
当比例项不为0时，如果微分项在一段时间里计算的结果与比例项对输出的贡献相同（即同为正或同为负）时，微分项相当于在一段时间里重复了比例项的作用，这段时间可理解为就是微分时间。
实际应用中应该合理选择kp,ti,td以确保三者对输出的贡献平衡，从而使控制对象在设定值的附近。
4.小结
4pid是比例、积分、微分的简称，pid控制的难点不是编程，而是控制器的参数整定。参数整定的关键是正确地理解各参数的物理意义，pid控制的原理可以用人对炉温的手动控制来理解。阅读本文不需要高深的数学知识。
1．比例控制
有经验的操作人员手动控制电加热炉的炉温，可以获得非常好的控制品质，pid控制与人工控制的控制策略有很多相似的地方。
下面介绍操作人员怎样用比例控制的思想来手动控制电加热炉的炉温。假设用热电偶检测炉温，用数字仪表显示温度值。在控制过程中，操作人员用眼睛读取炉温，并与炉温给定值比较，得到温度的误差值。然后用手操作电位器，调节加热的电流，使炉温保持在给定值附近。
操作人员知道炉温稳定在给定值时电位器的大致位置（我们将它称为位置l），并根据当时的温度误差值调整控制加热电流的电位器的转角。炉温小于给定值时，误差为正，在位置l的基础上顺时针增大电位器的转角，以增大加热的电流。炉温大于给定值时，误差为负，在位置l的基础上反时针减小电位器的转角，并令转角与位置l的差值与误差成正比。上述控制策略就是比例控制，即pid控制器输出中的比例部分与误差成正比。
闭环中存在着各种各样的延迟作用。例如调节电位器转角后，到温度上升到新的转角对应的稳态值时有较大的时间延迟。由于延迟因素的存在，调节电位器转角后不能马上看到调节的效果，因此闭环控制系统调节困难的主要原因是系统中的延迟作用。
比例控制的比例系数如果太小，即调节后的电位器转角与位置l的差值太小，调节的力度不够，使系统输出量变化缓慢，调节所需的总时间过长。比例系数如果过大，即调节后电位器转角与位置l的差值过大，调节力度太强，将造成调节过头，甚至使温度忽高忽低，来回震荡。
增大比例系数使系统反应灵敏，调节速度加快，并且可以减小稳态误差。但是比例系数过大会使超调量增大，振荡次数增加，调节时间加长，动态性能变坏，比例系数太大甚至会使闭环系统不稳定。
单纯的比例控制很难保证调节得恰到好处，完全消除误差。
2．积分控制
pid控制器中的积分对应于图1中误差曲线 与坐标轴包围的面积（图中的灰色部分）。pid控制程序是周期性执行的，执行的周期称为采样周期。计算机的程序用图1中各矩形面积之和来近似精确的积分，图中的ts就是采样周期。
4图1 积分运算示意图
每次pid运算时，在原来的积分值的基础上，增加一个与当前的误差值ev（n）成正比的微小部分。误差为负值时，积分的增量为负。
手动调节温度时，积分控制相当于根据当时的误差值，周期性地微调电位器的角度，每次调节的角度增量值与当时的误差值成正比。温度低于设定值时误差为正，积分项增大，使加热电流逐渐增大，反之积分项减小。因此只要误差不为零，控制器的输出就会因为积分作用而不断变化。积分调节的“大方向”是正确的，积分项有减小误差的作用。一直要到系统处于稳定状态，这时误差恒为零，比例部分和微分部分均为零，积分部分才不再变化，并且刚好等于稳态时需要的控制器的输出值，对应于上述温度控制系统中电位器转角的位置l。因此积分部分的作用是消除稳态误差，提高控制精度，积分作用一般是必须的。
pid控制器输出中的积分部分与误差的积分成正比。因为积分时间ti在积分项的分母中，ti越小，积分项变化的速度越快，积分作用越强。
3．pi控制
控制器输出中的积分项与当前的误差值和过去历次误差值的累加值成正比，因此积分作用本身具有严重的滞后特性，对系统的稳定性不利。如果积分项的系数设置得不好，其负面作用很难通过积分作用本身迅速地修正。而比例项没有延迟，只要误差一出现，比例部分就会立即起作用。因此积分作用很少单独使用，它一般与比例和微分联合使用，组成pi或pid控制器。
pi和pid控制器既克服了单纯的比例调节有稳态误差的缺点，又避免了单纯的积分调节响应慢、动态性能不好的缺点，因此被广泛使用。
如果控制器有积分作用（例如采用pi或pid控制），积分能消除阶跃输入的稳态误差，这时可以将比例系数调得小一些。
如果积分作用太强（即积分时间太小），相当于每次微调电位器的角度值过大，其累积的作用会使系统输出的动态性能变差，超调量增大，甚至使系统不稳定。积分作用太弱（即积分时间太大），则消除稳态误差的速度太慢，积分时间的值应取得适中。
4．微分作用
误差的微分就是误差的变化速率，误差变化越快，其微分绝对值越大。误差增大时，其微分为正；误差减小时，其微分为负。控制器输出量的微分部分与误差的微分成正比，反映了被控量变化的趋势。
有经验的操作人员在温度上升过快，但是尚未达到设定值时，根据温度变化的趋势，预感到温度将会超过设定值，出现超调。于是调节电位器的转角，提前减小加热的电流。这相当于士兵射击远方的移动目标时，考虑到子弹运动的时间，需要一定的提前量一样。
4图2 阶跃响应曲线
图2中的c (∞)为被控量c (t)的稳态值或被控量的期望值，误差e(t) = c (∞) - c (t)。在图2中启动过程的上升阶段，当 时，被控量尚未超过其稳态值。但是因为误差e(t)不断减小，误差的微分和控制器输出的微分部分为负值，减小了控制器的输出量，相当于提前给出了制动作用，以阻碍被控量的上升，所以可以减少超调量。因此微分控制具有超前和预测的特性，在超调尚未出现之前，就能提前给出控制作用。
闭环控制系统的振荡甚至不稳定的根本原因在于有较大的滞后因素。因为微分项能预测误差变化的趋势，这种“超前”的作用可以抵消滞后因素的影响。适当的微分控制作用可以使超调量减小，增加系统的稳定性。
对于有较大的滞后特性的被控对象，如果pi控制的效果不理想，可以考虑增加微分控制，以改善系统在调节过程中的动态特性。如果将微分时间设置为0，微分部分将不起作用。
微分时间与微分作用的强弱成正比，微分时间越大，微分作用越强。如果微分时间太大，在误差快速变化时，响应曲线上可能会出现“毛刺”。
微分控制的缺点是对干扰噪声敏感，使系统抑制干扰的能力降低。为此可在微分部分增加惯性滤波环节。
5．采样周期
pid控制程序是周期性执行的，执行的周期称为采样周期。采样周期越小，采样值越能反映模拟量的变化情况。但是太小会增加cpu的运算工作量，相邻两次采样的差值几乎没有什么变化，将使pid控制器输出的微分部分接近为零，所以也不宜将采样周期取得过小。
应保证在被控量迅速变化时（例如启动过程中的上升阶段），能有足够多的采样点数，不致因为采样点数过少而丢失被采集的模拟量中的重要信息。
6．pid参数的调整方法
在整定pid控制器参数时，可以根据控制器的参数与系统动态性能和稳态性能之间的定性关系，用实验的方法来调节控制器的参数。有经验的调试人员一般可以较快地得到较为满意的调试结果。在调试中最重要的问题是在系统性能不能令人满意时，知道应该调节哪一个参数，该参数应该增大还是减小。
为了减少需要整定的参数，首先可以采用pi控制器。为了保证系统的安全，在调试开始时应设置比较保守的参数，例如比例系数不要太大，积分时间不要太小，以避免出现系统不稳定或超调量过大的异常情况。给出一个阶跃给定信号，根据被控量的输出波形可以获得系统性能的信息，例如超调量和调节时间。应根据pid参数与系统性能的关系，反复调节pid的参数。
如果阶跃响应的超调量太大，经过多次振荡才能稳定或者根本不稳定，应减小比例系数、增大积分时间。如果阶跃响应没有超调量，但是被控量上升过于缓慢，过渡过程时间太长，应按相反的方向调整参数。
如果消除误差的速度较慢，可以适当减小积分时间，增强积分作用。
反复调节比例系数和积分时间，如果超调量仍然较大，可以加入微分控制，微分时间从0逐渐增大，反复调节控制器的比例、积分和微分部分的参数。
总之，pid参数的调试是一个综合的、各参数互相影响的过程，实际调试过程中的多次尝试是非常重要的，也是必须的。
1.硬件电路搭建
本实验使用司南电气控制stm32单片机开发板 来实现使用pid算法对啊直流电机的速度控制。
实验材料：
①司南电气控制stm32单片机开发板
②带编码器的直流电机
③oled显示屏
接线如图：
2.软件实现
pid算法，速度控制代码如下：
pid pid; //存放pid算法所需要的数据
void pid_calc() //pid计算
{
u8 strr[2],str[2]; //检测脉冲变量
float delek;
float ti,ki;
// float iout;
// float pout;
// float dout;
float td;
float kd;
float out;
extern float pulse; //检测脉冲变量
if(pid.c200ms<(pid.t)) //计算时间未到，200ms
{
return ;
}
led4=!led4;
//为什么是2.84？
/*
因为电机转一圈黄色线向单片机输出105.6个脉冲
=>pulse/105.6 （200ms的圈数）
=>(pulse/105.6)*5 （1s的圈数）
=>(pulse/105.6)*5*60 （1min的圈数）
=> pulse*2.48 （1min的圈数）
*/
pid.pv = pulse * 2.84; //速度采样
pid.ek=pid.sv-pid.pv; //得到当前的偏差值
pid.pout=pid.kp*pid.ek; //比例输出
pid.sek =pid.ek; //历史偏差总和
delek=pid.ek-pid.ek_1; //最近两次偏差之差
ti=pid.t/pid.ti;
ki=ti*pid.kp;
pid.iout=ki*pid.sek*pid.kp; //积分输出
td=pid.td/pid.t;
kd=pid.kp*td;
pid.dout=kd*delek; //微分输出
out= pid.pout pid.iout pid.dout;
//
if(out>pid.pwmcycle)
{
pid.out=pid.pwmcycle;
}
else if(out<0)
{
pid.out=pid.out0;
}
else
{
pid.out=out;
}
//pid.out =; //本次的计算结果
pid.ek_1=pid.ek; //更新偏差
tim2->ccr1 = (u16)pid.out;tim2->ccr4 = 0; //pwm输出
tim2->ccr2 = 0;tim2->ccr3 =(u16)pid.out; //pwm输出
sprintf(strr,"%0.1f\0",pid.out); //打印pwm输出值
oled_showstring(48,3,strr); //打印pwm输出值
sprintf(str,"%0.1f\0",pid.pv); //打印当前速度输出值
oled_showstring(56,6,str); //打印当前速度输出值
pid.c200ms = 0;
pulse = 0; //检测脉冲变量清零
}