本发明涉及一种伺服系统的角度预定方法,具体涉及一种基于预定角度与反馈角度偏差值的角度自适应步进预定方法。
背景技术:
雷达伺服系统的主要作用是隔离扰动,保证天线能够按照设计的扫描规律完成目标的搜索和跟踪。角度预定是伺服系统的基本功能之一,是为了实现天线波束的快速移动,将天线波束指向预定区域。
伺服系统的预定回路将天线当前指向位置与设定位置进行比较,通过电机驱动天线转动使两者间的差值减小直至满足精度要求。伺服系统的角度预装运动速度较快,特别是当伺服系统完成大范围搜索后进行目标回扫确认时,为保证伺服运动时,目标不会逃离天线预装位置的波束范围,通常会形成阶跃响应,会导致较大的角度超调出现。当伺服机构存在机械限位时,过大的超调量可能会导致天线碰撞机械限位,导致天线损坏。在伺服系统中由于天线转动空间有限,这点尤其明显,因此要求伺服系统的角度预装能有效减小或消除超调现象,具有较高的精度,同时保证角度预装响应的快速性。
针对伺服系统的角度预定超调,目前国内有专利申请cn105422681a(基于动态pid控制的液粘调速离合器控制方法)介绍了一种在运行状态下将从动轴转速作为直接控制对象,利用pid参数的动态变化来减小超调量的方法。该算法是通过动态调整pid参数来抑制超调,没有涉及通过自适应角度步进减小超调的技术。
专利申请cn106707740a(基于积分分离pid的数字电源环路补偿器的设计方法)介绍了一种通过积分分离的方式减小超调量和调整时间的方法。该方法使用积分分离技术,且应用于数字电路系统,应用场景不同。
专利申请cn206162032u(一种基于模糊自适应pid算法的三轴稳定器)介绍了一种基于模糊自适应pid的控制算法,计算量大,难以在低成本雷达伺服系统中实现。
2016年第21期的《中国机械中程》期刊中公开文献《基于自适应微分跟踪器的位置伺服系统》介绍了一种应用于用此同步电机的自适应微分跟踪控制器。该控制器用微分跟踪器对位置指令安排过渡过程,可以在运行过程中根据不同范围的阶跃信号自适应地选择最优过渡过程参数,实现了对阶跃指令大范围无超调的快速响应。该控制的应用对象是永磁同步电机,适用与交流伺服驱动系统,其使用环境与要求与本发明所设计的应用背景存在较大的差异性,所采用的最小二乘法拟合等方法在低成本伺服系统硬件系统上难以实现。
2012年第3期的《现代雷达》期刊中公开文献《基于模糊自整定pid控制方法的雷达伺服系统》介绍了将模糊自整定pid控制应用在雷达伺服系统中的一种应用。该方法通过二维模糊控制器实现对伺服系统中因齿隙、摩擦等非线性环节因素导致的pid控制中的非线性区的动态性能的改善。
技术实现要素:
本发明的目的在于提供一种雷达伺服系统的预定角度自适应步进控制方法,基于pid控制的原理,提出了一种基于预定角度与当前角度偏差值的伺服系统自适应角度预定技术,旨在用一种计算量较小且满足性能指标要求的方法解决雷达系统的角度预定时超调的问题。
为了达到上述目的,本发明的技术方案是提供一种雷达伺服系统的预定角度自适应步进控制方法,包含以下步骤:
s1、更新上位机预定角度值和伺服机构反馈角度值,执行步骤s2;
s2、计算自适应步进值;
s3、判断预定角度值是否发生变化,若发生变化,执行步骤s4,若未发生变化,执行步骤s5;
s4、位置回路给定值用反馈角度值赋值,执行步骤s5;
s5、判断预定角度值减去反馈角度值是否大于步进值,若大于执行步骤s6,否则执行步骤s9;
s6、位置回路给定值增加一个步进值,执行步骤s7;
s7、判断位置回路给定值是否大于预定角度值,若大于执行步骤s8,否则执行步骤s12;
s8、位置回路给定值用预定角度值赋值,执行步骤s12;
s9、判断反馈角度值减去预定角度值是否大于步进值,若大于执行步骤s10,否则执行步骤s8;
s10、位置回路给定值减去一个步进值,执行步骤s11;
s11、判断位置回路给定值是否小于预定角度值,若小于执行步骤s8,否则执行步骤s12;
s12、通过pid算法计算得到控制输出值,送给功率放大器驱动电机旋转,返回步骤s1。
本发明基于预定角度与当前角度偏差值的角度自适应步进预定方法,通过将上位机给出的角度预定值自适应地划分为若干段,步进地送给雷达伺服系统的位置回路,从而避免对系统产生较大冲击,解决位置预定过程中超调量指标与过渡过程时间指标的矛盾,减小超调量的同时保证控制系统具有较高的快速性。
本发明与现有技术相比具有以下优点:
现有的雷达伺服系统角度预装方法直接将预定角度加到控制系统中,当预定角度较大时会对伺服机构产生较大冲击,致使出现大的超调量,在有限位的伺服机构中容易损坏伺服机构。
本发明将预定角度步进地送给控制系统,避免了对控制系统施加大冲击,有效减小了系统超调量。
本发明中步进角度值可以根据上一时刻的控制效果自适应调整,在减小超调量的同时保证系统的快速性。
附图说明
图1为本发明的方法流程图;
图2为本发明实施例的雷达伺服系统结构示意图;
图3为本发明实施例的角度预定过程仿真结果图。
具体实施方式
本发明提供一种雷达伺服系统的预定角度自适应步进控制方法,包含以下步骤:
s1、更新上位机预定角度值和伺服机构反馈角度值,执行步骤s2;
s2、计算自适应步进值;
s3、判断预定角度值是否发生变化,若发生变化,执行步骤s4,若未发生变化,执行步骤s5;
s4、位置回路给定值用反馈角度值赋值,执行步骤s5;
s5、判断预定角度值减去反馈角度值是否大于步进值,若大于执行步骤s6,否则执行步骤s9;
s6、位置回路给定值增加一个步进值,执行步骤s7;
s7、判断位置回路给定值是否大于预定角度值,若大于执行步骤s8,否则执行步骤s12;
s8、位置回路给定值用预定角度值赋值,执行步骤s12;
s9、判断反馈角度值减去预定角度值是否大于步进值,若大于执行步骤s10,否则执行步骤s8;
s10、位置回路给定值减去一个步进值,执行步骤s11;
s11、判断位置回路给定值是否小于预定角度值,若小于执行步骤s8,否则执行步骤s12;
s12、通过pid算法计算得到控制输出值,送给功率放大器驱动电机旋转,返回步骤s1。
上述的雷达伺服系统的自适应角度预定方法中,所述步骤s2计算自适应步进值的方法为:
s(k)=s(k-1)+α·(g(k-1)-f(k-1))(1)
其中,s(k)表示k时刻的步进角度值;g(k)表示k时刻的给定角度值,初值设为0;f(k)表示k时刻的反馈角度值,初值设为0;α表示大于零的系数。
步进角度初始值s(0)设置为期望的预定过程速度,可按下式计算:
s(0)=v·t(2)
其中,v表示期望的预定过程速度,t表示控制周期。
式(1)反映了k时刻的步进角度值跟随k-1时刻给定角度值与反馈角度值差值自适应变化的过程。当k-1时刻给定角度值减去反馈角度值为正值时,说明步进角度值过小,控制输出不足以驱动电机克服摩擦力矩等因素转动到给定角度值,导致系统快速性降低,此时需要在k时刻增大步进角度值,增加的幅度取决于系数α的大小,而α的取值可以在实际工程应用中试凑得到,不同的伺服机构对象其α值是不同的。反之当k-1时刻给定角度值减去反馈角度值为负值时,说明步进角度值过大,系统出现超调,此时需要在k时刻减小步进角度值进行修正。通过以上过程步进角度值自适应地跟随上一时刻系统控制性能的变化而变化,在保证控制系统快速性的同时减小系统的超调量。
所述步骤s3中,判断预定角度值p(k)和上一时刻p(k-1)是否相同,若不同执行步骤s4,初始化给定角度值,若相同执行步骤s5。
所述步骤s5中,判断预定角度值减去反馈角度值是否大于步进值,若满足
p(k)-f(k)>s(k)(3)
说明给定角度值应该正向累加,即执行步骤s6,否则执行步骤s9。
所述步骤s6的算法为:
g(k)=g(k-1)+s(k)(4)
所述步骤s7中,判断给定角度值是否大于预定角度值,若满足
g(k)>p(k)(5)
说明给定角度值已经累加到预定角度,应该停止累加,即执行步骤s8。
所述步骤s9中,判断反馈角度值减去预定角度值是否大于步进值,若满足
f(k)-p(k)>s(k)(6)
说明给定角度值应该负向累加,即执行步骤s10。
所述步骤s10的算法为:
g(k)=g(k-1)-s(k)(7)
所述步骤s11中,判断给定角度值是否小于预定角度值,若满足
g(k)<p(k)(8)
说明给定角度值已经累加到预定角度,应该停止累加,即执行步骤s8。
所述步骤s12中pid算法的基本方程为:
u(k)=kp·err(k)+ki·∑err(k)+kd·(err(k)-err(k-1))(9)
其中,
err(k)=g(k)-f(k)(10)
err(0)=0
u(k)表示控制量输出,kp表示比例系数,ki表示积分系数,kd表示微分系数。
因为在步骤s2中已经将预定角度值自适应划分为若干步进角度值,此时控制系统偏差值err(k)较小,可以使用较大的比例系数kp,在提高控制系统快速性的同时保证较小的超调量。
以下结合附图1、2和3,通过详细说明一个较佳的具体实施例,对本发明做进一步阐述。
实施例条件:假定控制对象电机输入电压u到输出转速y的传递函数如式
电机轴到负载的齿轮减速比为50,则控制系统示意图如图2。
设置预定角度从0时刻的0度跃变为1时刻的10度,k=1时刻预定过程开始。
如图1所示,利用本发明提出的方法,对上述实施例条件执行以下步骤:
s1、更新预定角度值和反馈角度值:
k=1时刻预定角度值更新为p(1)=10,反馈角度值f(1)=0。而上一时刻k=0时p(0)=0。
s2、计算自适应步进角度值:
s(1)=s(0)+α·(g(0)-f(0))
其中预定速度设置为200°/s,控制周期设置为0.001s,则步进角度初值s(0)=0.2;系数α设为0.001;g(0)=0;f(0)=0。
s3、判断预定角度值是否发生变化,
因为p(1)≠p(0),预定角度值发生变化,执行步骤s4。
s4、位置回路给定值用反馈角度值赋值:
g(1)=f(1)
s5、判断下式是否成立:
p(1)-f(1)>s(1)
若成立执行步骤s6,否则执行步骤s9;
s6、位置回路给定值增加一个步进值,执行步骤s7;
g(1)=g(1)+s(1)
s7、判断下式是否成立:
g(1)>p(1)
若成立执行步骤s8,否则执行步骤s12;
s8、位置回路给定值用预定角度值赋值,执行步骤s12;
g(1)=p(1)
s9、判断下式是否成立:
f(1)-p(1)>s(1)
若成立,执行步骤s10,否则执行步骤s8。
s10、位置回路给定值减去一个步进值,执行步骤s11;
g(1)=g(1)-s(1)
s11、判断下式是否成立:
g(1)<p(1)
若成立执行步骤s8,否则执行步骤s12;
s12、通过pid算法计算得到控制输出值,计算过程如下:
err(1)=g(1)-f(1)
u(1)=kp·err(1)+ki·∑err(1)+kd·(err(1)-err(0))
其中pid算法系数设置为kp=7.5,ki=0,kd=0,u(1)送给功率放大器驱动电机旋转返回步骤s1,开始k=k+1,即k=2时刻的控制周期计算,以此类推控制雷达伺服系统转动到预定角度。
通过仿真计算得到加入自适应步进算法和未加入自适应步进算法的控制系统响应结果,如图2所示。超调量和过渡过程时间对比如表1所示。
表1性能对比表
从表1中可知加入本发明所述的自适应步进算法后在过渡过程时间保持相近的情况下大幅减小了系统的超调量,系统超调量从49.75%降低至6.88%,克服了控制系统中超调量指标和过渡过程指标的矛盾,使两个指标都取得了理想的效果。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。