简介:为了实际实现具有良好跟踪精度和抗干扰能力的惯性平台稳定回路,建立了平台伺服电机的离散时间模型,设计了由单片机和高速DSP组成的数字控制系统,与惯性平台组成了基于采样数据的平台稳定控制回路,研究了离散变结构控制趋近律的选取方法,采用改进趋近律设计了离散变结构控制律,提出了一种数字式平台稳定回路的离散变结构控制方法,通过实物实验得出了平台伺服电机转轴摩擦力矩模型系数的估计值,并将其引入到控制系统中。仿真实验结果表明,该回路系统对于摩擦力矩和系统参数不确定性具有一定的抗干扰性能,对于阶跃干扰力矩输入具有良好的动态特性,且静态力矩刚度提高到1.2×10^4N·m/rad,系统对于斜坡和加速度输入信号实现了平稳跟踪,跟踪误差最大值分别为0.0056rad和0.0597rad。
简介:提出了一种基于期望模式修正(EMA)的改进交互式多模型(IMM)算法。该算法主要解决自主水下航行器(AUV)复杂工作环境下量测噪声统计特性未知或易发生变化时的状态估计问题,其核心思想是将期望模式修正机制和交互式多模型滤波算法相结合,利用状态估计过程中的获取的模型概率进行决策,得到更加接近与系统真实模式的期望模型集合,再通过期望模型集合滤波结果对固定模型集合滤波结果进行修正。与传统的交互式多模型算法相比,提出的基于期望模式修正的交互式多模型算法可以捕捉到系统模式更细微的变化。仿真结果表明,该算法可以大幅提高AUV组合导航系统的估计精度和稳定性。