基于双核DSP的反无人机伺服转台控制方法、装置及系统与流程

摘要: 本发明涉及伺服控制,具体涉及一种反无人机伺服转台的控制技术。背景技术:1、对低空慢速小型飞行目标进行高精度跟踪的伺服转台技术近年来受到广泛关注。此类光电或雷达跟...
基于双核DSP的反无人机伺服转台控制方法、装置及系统与流程

本发明涉及伺服控制,具体涉及一种反无人机伺服转台的控制技术。

背景技术:

1、对低空慢速小型飞行目标进行高精度跟踪的伺服转台技术近年来受到广泛关注。此类光电或雷达跟踪转台作为精密指向与跟踪系统的执行机构,主要针对低空、慢速、小型无人机及高机动穿越机实施动态跟踪,要求伺服转台系统具备百微秒级的动态响应速度与亚毫弧度级的跟踪精度。伺服转台多架设于野外开放式露天环境,其搭载的光电舱或雷达天线阵面具有较大的迎风面积,在突发阵风下会产生显著的随机风载力矩,同时叠加机械传动摩擦以及电缆绞缠力矩等多重时变非线性干扰,形成集总未知扰动,严重影响转台的跟踪精度与稳定性。

2、传统比例积分微分控制属于线性控制方法,对系统强非线性及目标高机动换向突弯缺乏鲁棒性。滑模控制因对参数摄动和外部扰动具有不变性而被引入转台伺服控制,但为压制野外随机风载,其切换增益常设为较大值,由此引发电机高频啸叫、齿轮间隙敲击及机械共振,加速机械结构磨损。采用固定边界层的饱和函数或双曲正切函数进行连续化可在一定程度上缓解抖振,但在目标实施大机动运动时,位置跟踪误差极易在换向瞬间冲破预设的固定边界层,使系统瞬间切换回非连续的硬切换区,引发控制量饱和阶跃与机械暂态剧烈震颤,直接导致跟踪目标丢失或指向偏移。此外,现有引入群智能算法在线优化控制参数的方案,因群智能算法具备多群体、多代迭代的计算特征,计算复杂度极高,在百微秒级控制周期内运行极易产生计算超时,破坏系统的硬实时性并引发卡死,而采用离线仿真结合嵌入式查表的方式又无法匹配野外随机风场与动态机动轨迹,缺乏在线自愈调整能力。

3、综上,现有技术面临的核心问题在于:固定边界层滑模控制在大机动运动时易冲出边界层引发控制量阶跃与机械震颤,导致跟踪失稳与目标丢失;群智能算法在线运行的计算实时性与嵌入式硬件平台的算力之间存在冲突,难以在保障硬实时控制的前提下实现控制参数的在线滚动优化。

技术实现思路

1、本发明解决了现有技术中固定边界层滑模控制在大机动运动时易冲出边界层引发控制量阶跃与机械震颤,以及群智能算法在线运行的计算实时性与嵌入式硬件平台算力存在冲突,难以在保障硬实时控制的前提下实现控制参数在线滚动优化的问题。

2、基于dsp双核架构的反无人机伺服转台控制方法,所述方法由双核dsp控制器执行,所述双核dsp控制器cpu1运行高频硬实时控制环路,cpu2运行低频参数寻优环路,二者通过核间通信交互信息;所述方法包括:

3、高频硬实时控制步骤:

4、按照高频控制周期获取转台目标期望角度和转台实际角度;

5、每个高频控制周期内,根据当前目标期望角度和实际角度,计算误差数据,并将所述误差数据存入锁存堆栈;

6、基于所述误差数据构建自适应滑模控制律,计算控制量作为转台的驱动信号输出,并同步发送给cpu2;

7、基于接收到的最优参数组合,更新当前自适应滑模控制律中的待优化参数;

8、低频参数寻优步骤:

9、在每个寻优周期内,从所述锁存堆栈读取上一个寻优周期内存储的所有误差数据,构建历史误差序列,并获取所述历史误差序列中各误差数据对应的控制量,基于所述历史误差序列及对应的控制量计算适应度评价函数;

10、以所述适应度评价函数为优化目标,采用轻量化麻雀搜索算法对所述自适应滑模控制律中的待优化参数进行在线寻优,得到最优参数组合;

11、将所述最优参数组合发送给cpu1。

12、进一步优选方案,所述基于所述误差数据构建自适应滑模控制律包括:

13、基于误差数据构造滑模切换面:

14、

15、其中,为滑模面系数,所述误差数据包括位置跟踪误差及其变化率;

16、采用饱和函数对滑模切换控制进行连续化,为滑模面的预设边界层厚度;为所述滑模切换面;

17、将系统所受外部扰动及未建模动态等效为集总扰动,以自适应学习率对所述集总扰动进行自适应估计,得到扰动补偿值:

18、

19、计算控制量:

20、

21、其中为标称转动惯量,为趋近律切换增益;所述待优化参数为滑模面系数、趋近律切换增益和自适应学习率。

22、进一步优选方案,所述高频控制周期为百微秒级,所述控制量为pwm信号,所述pwm信号的周期和高频控制周期同步;所述寻优周期为毫秒级。

23、进一步优选方案,所述适应度评价函数为:

24、

25、其中为所述历史误差序列的数据组数,为控制量权重抑制因子;为高频控制周期。

26、进一步优选方案,所述轻量化麻雀搜索算法中,种群规模为10-30只,最大迭代次数为2-5次;所述轻量化麻雀搜索算法以参数向量[,,]作为个体位置,将种群划分为发现者、加入者和预警者,其中发现者占种群的20%,加入者占60%~70%,预警者占10%~20%;其位置更新规则如下:

27、发现者位置更新:

28、

29、其中为当前迭代次数;分别代表参数[,,];为(0,1]之间的随机数;[0,1]为当前环境的预警值,[0.5,1]为安全阈值;是服从标准正态分布的随机数;是一个1×3的全1向量;

30、加入者位置更新:

31、

32、其中为当前发现者所占据的最优位置;为当前全局最差位置;是一个1×3的全1向量,每个元素随机赋值为1或-1,

33、且;

34、预警者位置更新:

35、

36、其中,为当前全局最优位置;为步长控制参数;为[-1,1]之间的随机数;为当前麻雀的适应度值,和分别为当前的全局最佳和最差适应度值;为极小的常数。

37、进一步优选方案,所述核间通信具体为:所述将所述最优参数组合发送给cpu1的方式为通过ipc硬件中断的方式发送,cpu1响应该中断,在中断服务中采用原子操作改写控制参数寄存器为所述最优参数组合。

38、进一步优选方案,在更新当前自适应滑模控制律中的待优化参数时,对最优参数组合[,,]施加物理硬限幅:∈[5,120],∈[0.5,30],∈[0.01,5]。

39、进一步优选方案,所述低频参数寻优步骤还包括触发式自适应节能寻优:

40、在每个寻优周期内,cpu2从所述锁存堆栈读取误差数据后,根据所读取的误差数据计算实时方差;

41、当所述实时方差<预设阈值时,cpu2判定当前工况为平稳跟踪工况,自动挂起所述轻量化麻雀搜索算法的迭代,保持当前控制参数,跳过本次寻优;

42、当所述实时方差≥所述预设阈值时,cpu2判定当前工况为突变工况,通过硬件中断唤醒所述轻量化麻雀搜索算法的迭代,重新启动所述轻量化麻雀搜索算法进行参数寻优。

43、基于双核dsp的反无人机伺服转台控制装置,所述装置包括高频硬实时控制模块和低频参数寻优模块,二者通过核间通信交互:

44、高频硬实时控制模块包括:

45、信号获取单元,用于按照高频控制周期获取转台目标期望角度和转台实际角度;

46、误差计算单元,用于每个高频控制周期内,根据当前目标期望角度和实际角度,计算误差数据,并将所述误差数据存入锁存堆栈;

47、控制量计算单元,用于基于所述误差数据构建自适应滑模控制律,计算控制量作为转台的驱动信号输出,并同步发送给cpu2;

48、低频参数寻优模块包括:

49、误差提取单元,用于在每个寻优周期内,从所述锁存堆栈读取上一个寻优周期内存储的所有误差数据,构建历史误差序列;

50、适应度评价单元,用于获取所述历史误差序列中各误差数据对应的控制量,基于所述历史误差序列及对应的控制量计算适应度评价函数;

51、参数寻优单元,用于以所述适应度评价函数为优化目标,采用轻量化麻雀搜索算法对所述自适应滑模控制律中的待优化参数进行在线寻优,得到最优参数组合;

52、参数更新单元,用于将所述最优参数组合发送给cpu1。

53、基于双核dsp的反无人机伺服转台控制系统,用于所述基于双核dsp的反无人机伺服转台控制方法,所述系统包括:

54、tms320f28379d双核dsp控制器,内部包括cpu1和cpu2,二者通过ipc和共享ram进行核间通信;所述cpu1运行时执行高频硬实时控制步骤;

55、光电或雷达传感器,用于实时采集转台目标期望角度;

56、qep编码器,用于按照高频控制周期采集转台实际角度;

57、电机驱动器,用于接收所述cpu1输出的控制量,基于该控制量输出电机驱动信号给永磁同步电机;

58、永磁同步电机用于驱动转台转动;

59、所述cpu1和cpu2中分别嵌入有计算机程序,当所述计算机程序运行时,cpu1执行所述高频硬实时控制步骤,cpu2执行所述低频参数寻优步骤。

60、本发明与现有技术相比较的有益效果为:

61、本发明通过构建自适应滑模控制律,以饱和函数对滑模切换控制进行连续化,并以自适应学习率对集总扰动进行在线自适应估计,实现了滑模边界层与趋近系数的动态调节,将跟踪误差约束于平滑区间,缓解了滑模硬切换抖振,减少了伺服震颤造成的成像模糊与激光指向偏移,适配大机动运动时的稳定跟踪需求。

62、本发明通过将风载力矩、摩擦力矩、电缆耦合力矩统一等效为集总扰动并进行在线自适应估计,将扰动补偿值前馈至控制量计算中,实现了对多源扰动的自适应统一补偿,依据扰动强度自适应匹配切换增益,在弱风工况下抑制齿轮振动噪声,在强风工况下强化抗扰性能,减小了传动交变冲击,延缓了机械磨损。

63、本发明通过双核dsp控制器中cpu1运行高频硬实时控制环路、cpu2运行低频参数寻优环路的双核任务解耦架构,以及两核间通过核间通信完成参数交互的机制,实现了高频伺服控制与低频寻优运算的异步并行,从硬件层面隔离算力抢占,规避了控制周期超时与程序卡死,保障了硬实时控制。

64、本发明通过计算锁存堆栈中误差数据的实时方差并以预设阈值为判据,控制cpu2中轻量化麻雀搜索算法迭代状态机的挂起与唤醒,实现了误差触发式间歇寻优,在稳态工况暂停迭代计算以降低dsp运算功耗与芯片发热,在突变工况立即重启寻优以恢复参数动态调整,适配野外长期无人值守工作场景。

65、本发明所述基于双核dsp的反无人机伺服转台控制方法、装置及系统,适用于光电跟踪转台、精密指向控制、高机动目标跟踪控制等领域。