摘要
针对"动中通"系统两次上位机指令间隔中载体姿态变化的扰动,提出了基于三轴陀螺和加速度计的稳定回路跟踪控制方法。该方法在传统伺服系统电流环、速度环和位置环的反馈回路中增加了负载速度前馈补偿和稳定回路位置校正环节。利用陀螺和加速度计的测量数据融合、稳定跟踪修正的原理隔离载体姿态变化,对测量噪声信号用卡尔曼滤波技术进行估计和误差补偿,有效地提高了系统对姿态扰动的隔离度。仿真验证结果表明,伺服稳定系统的响应时间小于200ms,动态跟踪误差小于0.1°,隔离度高于97%,具有较高的跟踪精度,能够满足工业应用稳定跟踪控制。
- 单位